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ABSTRACT 


This report treats two central topics related to the dynamical aspects of 
the control problem of the six degrees of freedom JPL Robot Research Project 
(RRP) manipulator: (a) variations in total inertia and gravity loads at the joint 
outputs, and (b) relative importance of gravity and acceleration-generated reac- 
tion torques or forces versus inertia torques or forces. The relation between 
the dynamical state equations in explicit terms and servoing the manipulator is 
briefly discussed in the framework of state . ariable feedback control which also 
forms the basis of adaptive manipulator control. 

Exact state equations have been determined for total inertia and gravity 
loads at the joint outputs as a function of joint variables, using the constant 
inertial and geometric parameters of the individual links defined in the respec- 
tive link coordinate frames. The range of maximum variations in total inertia 
and gravity loads at the joint outputs has been calculated for both no load and 
load in the hand. 

The main result of this report is the construction of a set of greatly sim- 
plified state equations which describe total inertia and gravity load variations 
at the output of the six joints with an average error of less than 5%. The sim- 
plified state equations also show that most of the time the gravity terms are 
more important than the inertia terms in the torque or force equations for joint 
numbers 2, 3, 4, and 5. Further, the acceleration-generated reaction torques 
or forces, except from extreme arm motion patterns, are shown to have very 
low quantitative significance as compared to the straight inertial torques or 
forces in the dynamic equations restricted to simultaneous motions at the first 
three joints. 

The results are summarized in four tables and nine figures. The report 
also contains all analytic tools and byproducts needed to arrive at the outlined 
conclusions. An important analytical byproduct is the simplification of the 
general matrix algorithm for manipulator dynamics. 
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I. INTRODUCTION 


The purpose of control is to keep fixed or alter the dynamical behavior of 
a physical system in accordance with man 1 s wishes formulated in terms of per- 
formance requirements and goals. The nature of the control problem com- 
prises two distinct parts: (a) quantitative description of the dynamical 

behavior of the physical system (in our case, the manipulator) to be controlled 
and (b) specification of a "scheme" or control law for carrying out the desired 
controlled behavior (in our case, to accomplish a variety of manipulative tasks 
with specified performance). This report is mainly about the former part of the 
manipulator control problem: 

Modeling and evaluating the dynamical properties and 
behavior of the JPL Robot Research Project (RRP) 
manipulator. 

The fundamental idea of control is that the inputs should be computed 
from the state. Of course, this idea is known as feedback. Thus, the natural 
framework for formulating and solving control problems is the state description 
of the physical system. The state incorporates all information necessary to 
determine the control action to be taken since, by definition of a dynamical 
system, the future evolution of the system is completely determined by its 
present state and the future inputs. The relation between explicit state equa- 
tions for manipulator dynamics and servoing the manipulator is briefly treated 
in Section II. 

The actual dynamical model for the six degrees of freedom JPL RRP 
manipulator can be obtained from known physical laws (from the laws of the 
Newtonian mechanics) and from physical measurements. This task amounts 
to the development of the equations of motion for the six manipulator joints 
in terms of specified (measured) geometric and inertial parameters of the 
links. Conventional procedures could then be applied to develop the actual 
motion equations. Instead of using conventional procedures, the equations of 
motion in this report are developed through the application of a general 
algorithmic description of manipulator dynamics. The algorithm is based 
on a specific representation of link coordinate frames in jointed mechanisms 
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and the formalism of the Lagrangian mechanics. The features of the gentral 
algorithm together with the definitions of the involved functional symbols and 
mathematical operations are described in Section III. Section III also provides 
a general specification of the six equations of motion for the JPL RRP manipu- 
lator as well as a condensed physical explanation of the different terms 
appearing in the equations. Section III concludes with a compact vector /matrix 
description of the six motion equations. 

The complete dynamical model of the JPL RRP manipulator is described 
by a set of six coupled nonlinear differential equations. Each equation contains 
a large number of torque or force terms classified into four groups: (a) inertial 
torque or force, (b) reaction torques or forces generated by acceleration at 
other joints, (c) velocity-generated (centripetal and Coriolis) reaction torques 
or forces, and (d) gravity torque or force. With few exceptions, each torque 
or force term depends on the instantaneous configuration (position) of several 
links. To gain analytic insight into the dynamical behavior of the manipulator 
in terms of explicit state equations while keeping the analysis manageable, 
well-defined and useful dynamical model restrictions are identified in Sec- 
tion IV, It is emphasized, however, that the model restrictions are introduced 
only for analytic purposes. 

In Section V explicit state equations are presented for inertial, gravity, 
and acceleration- gene rated reaction torque /force terms for manipulator 
motions rest-icted to the first three joints. The last three (wrist) joints are 
thought to be temporally at rest in a known configuration. While in Section VI 
complete (unrestricted) explicit state equations are presented for inertial and 
gravity torques or forces acting at all six joint axes. The exact state equations 
developed in Sections V and VI form one part of the important results of this 
report. 

Partial derivatives of the different link coordinate transformation 
matrices as well as the pseudo inertia matrices (together with numerical 
values of inertial components) utilised in the development of the explicit state 
equations are compiled in Appendices A and B. Modifications of the explicit 
and exact state equations for inertial and gravity terms when a load is 
emplaced in the hand are treated in Appendix C. 
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The concluding part of the report is Section VII organized in five 
subsections. From the exact state equations and numerical vr.i‘,e-, i* 'nertial 
components of the JPL RRP manipulator the following concluding comp nations 
are made: 

• Maximum and minimum values of total inertia seen at all six 
joint axes are determined in subsection VII. A; the constant and 
varying components of total inertias are separated out in the 
computations. 

• Maximum gravity load variations seen at the different joint axes 
are determined in subsection VII, B. 

The maximum total inertia and gravity load variations have been calcu- 
lated for both no load and load in the hand. (The load is a 1.8 kg, 442 cm 
cube placed with its mass center at the origin of the hand coordinate frame.) 
Utilizing the exact state equations restricted to simultaneous motions at the 
first three manipulator joints, 

• The relative importance of acceleration-generated reaction 
torques/forces versus inertial torques forces is quantitatively 
evaluated in subsection VII, C. 

The main result of this report is 

• The development of simplified state equations for total inertial 
and gravity loads at all six joint axes, presented and evaluated 
regarding accuracy in subsection VII. D. 

Parameters dependent on a load in the hand are separated out in the 
simplified state equations. Utilizing the simplified state equations, 

• The relative importance of gravity load versus inertial load in 
the torque/force equations is quantitatively evaluated in 
subsection VII. E, normalized to unit acceleration. 

It is shown that the gravity terms in most of the time of normal (not too 
fast) arm operation are more important than the inertial terms for joints 
Nos. 2, 3, 4, and 5 in the gravity field of Earth. 
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The development and evaluation of explicit state equations for total 
inertial and gravity loads acting at the six arm joint axes form the basic 
dynamical model for the JPL RRP manipulator under operating conditions 
when acceleration- and velocity-generated reaction torques or forces can be 
neglected. The relative significance of the different reaction terms in the 
complete torque /force equations for fast arm movements will be evaluated in 
a separate report after the determination of explicit state equations for all 
existing reaction torques and forces* 

General simplification of the algorithmic definitions for ail dynamic 
coefficients of any manipulator is introduced and mathematically justified in 
Appendix D at the end of the report. 
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II. DYNAMICAL MODEL AND CONTROL SYSTEM DESIGN 


The RRP manipulator under consideration is a coupled electromechanical 
system. The inputs to the system (with which control is accomplished) are 
torque generated by motors driving the joints. The outputs are joint position 
and motor shaft velocity measurements. This input/output description forms 
the definition of the manipulator as a dynamical system. To make this dynami- 
cal system definition (or dynamical model) quantitative, mathematical relations 
are required which relate input to output. The mathematical relation between 
input (torque) and output (position and velocity) is obtained by the specification 
of state equations (differential equations) governing the manipulator motion. 

The execution of purposeful manipula' ' tasxs requires two types of 
performance from the viewpoint of servo control: (1) positioning the manipulator, 
and (2) exerting torques or forces on objects through the manipulator. Manipu- 
lator positioning is a task of controlling the relative displacement of several 
links connected by single degree of freedom joints. The positioning control 
problem can be subdivided into two classes: (a) point-to-point control, and 
(b) continuous path control. In point-to-point control mode only the final 
(terminal) joint variable values are specified as "desired output". While 
in continuous path control mode the "desired output" is a closed time history 
(time sequence) of joint variable values. The strict space-time coordination 
of several joint variable values defines a continuous path for manipulator 
motion in the work space. 

The objective of closed loop (feedback) control is to reduce the effect 
of external disturbances and system parameter changes on the desired system 
output. In the case of position- servoing a manipulator, the notion "external 
disturbances" can be used in a broad sense: they can include known effects 
deliberately neglected in the mathematical form of the dynamical model. (For 
instance, neglected small reaction torques or forces, neglected small link 
mass center offsets, etc. ) There is, however, a limit on the range of changes 
in system parameters and disturbances which can be tolerated without deterior- 
ation of desired servo performance. In general, the acceptable variation 
in system parameters can be extended by readjusting (varyiug) feedback gains. 
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In particular, for a critically damped position servo using velocity feedback, 
an essential system parameter is the total effective inertia if Jt is decreased 
by a factor "n" relative to a nominal value the damping and natural frequency 
are both increased by a factor s/h; but reduction of the velocity feedback con- 
stant to -Jh to its original (nominal) value will restore critical damping. (See, 
for instance, Refs. 1, 2, 3. ) Manipulator motion general and load handling 
in particular imply considerable variations in total effective inertia as seen 
at the different joint drives. Therefore, to maintain a required servo perfor- 
mance despite variations in must be known explicitly as a function of joint 

variables (or implicitly as a function of time for a given motion program). 

A strict continuous path control requires a uniform servo performance. 
Thus, it is important to obtain an appropriate state description for total 
effective inertia variations as seen at the different joint drives. One outcome 
of the manipulator dynamic model analysis contained in this report is the 
specification of state functins for variations in total effective inertias, with 
or without load in the hand. 

The gravity load acting at the different joint drives during arm motion 
is an important dynamic factor in commanding torques to obtain a desired 
manipulator position output in a continuous path control mode. Another out- 
come of the manipulator dynamic model analysis of this report is the specifica- 
tion of state functions for variations in gravity loads as s^en at the different 
joint drives during arm motion, with or without load in the hand. 

The speed of arm motion can be interpreted both kinematically and dynam- 
ically. The kinematic interpretation considers only the time required to 
move for instance the fingertip from one point to another in the workspace, 
while the dynamic interpretation of arm speed considers the torques or forces 
acting at both the different joints and the fingertip during arm motion. A 
useful dynamic definition for "fast" or "slew" arm motion can be formulated 
in terms of reaction torques or forces induced by the arm motion: the arm 
motion is "slow" if the effect of induced reaction torques or forces can be 
neglected in commanding torques to obtain desired position outputs; if not, 
then the motion is "fast" in a dynamic sense. It is noted that an arm motion 
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can be "slow” in a dynamic sense but still be ’’fast" in a kinematic sense. 
Another outcome of manipulator dynamic model analysis is to contribute to 
the establishment of the boundary between dynamically ’’slow” and 1 1 fast 1 arm 
motion with respect to control system performance. 

Figure 1 shows schematically the RRP manipulator position servo control 
under development, indicating also the relation of manipulator dynamical 
model and servo design. 
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III. GENERAL MODEL FOR MANIPULATOR DYNAMICS 


The general equations of motion for jointed mechanisms (manipulators) can 
conveniently be expressed through the application of the Lagrangian equations 
for nonconservative systems (Ref, 4). Many investigators in the field of 
computer- controlled manipulation in the U.S. A. employ the Lagrangian tech- 
nique to formulate the dynamic and control problem of manipulators, and apply 
the Hartenberg-Denavit representation of coordinate frames in jointed mecha- 
nisms to the definition of manipulator inertial parameters and dynamic variables 
(Refs. 5, 6, 7 and 8). The application of the Lagrangian formalism together 
with the Hartenberg-Denavit link coordinate representation results in a conven- 
ient and compact algorithmic description of the manipulator equations of motion. 
The algorithm is expressed by matrix operations (Ref. 5), and facilitates both 
analysis and computer implementation. The evaluation of the dynamic and con- 
trol equations iu functionally explicit terms in this and subsequent memos will 
be based on the compact matrix algorithm developed in Ref. 5. 

A. The General Dynamic Algorithm 

For clarity and easy reference, the general dynamic algorithm as applied to 
manipulators is repeated here together with the corresponding definitions. The 
associated manipulator coordinate system conventions and transformations 
together with their application to the JPL RRP manipulator* should be consulted 
whenever necessary. 

The general algorithm which describes the manipulator equations of motion is 
given by the following expression for the torque or force F. acting at joint "i": 



where superscript T denotes the transpose of the matrix U^, and 


♦Lewis, R. A. , Bejczy, A. K. , "RRP Manipulator Conventions, Coordinate 
Systems, and Trajectory Considerations, " JPL Guidance and Control 
Technical Memo 343-174, 1 December 1972. 
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= torque or force acting at joint "i" (that is, corresponding to the 
joint variable q.), 

q^ = "joint variable i", i = 1 j, . . . , k p, .... n where "n" 

denotes the degree-of-freedom (that is, the total number of joint 
variables) of the manipulator, 

q^, ^i = velocit y an< ^ acceleration, respectively, cf joint variable "i". 

The "building blocks" rm, py G, U^, and Jj of Eq. (1) are defined as 

follows: 


rrij = the mass of body "j" in the chain of "n" bodies (links). 

Pj = mass center vector of body (link) "j" in the coordinate system 

fixed in the same body, given as a 4 x 1 vector with components 


x. 

J 


P. 

J 



( 2 ) 


1 


G = acceleration of gravity, given as a 1 x 4 vector with components 

G = [g x , G y . G z . o] (3) 

= the first partial derivative of the transformation matrix with 
respect to q^. It is a 4 x 4 matrix. The transformation matrix 
is defined as 


T-* = 

A 0 


T*T 2 

A o A i 


T * I 

J-l 


j s n 


10 


which relates a point given in the "j" frame to the base reference 
frame "0". 
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Since an individual transformation matrix T., ^ depends only on 
q^, it is convenient to express the derivative of t! ^ with respect 
to through matrix operators Q. Thus, we have the following 


expression for U^: 


// aTJ 

u . . £2 . t!t? 

jx 9q^ 0 1 




T-J 

J-l 




i 5 j 


( 4 ) 


where for a rotational joint variable q^ = 0^ we have 


Q = Q 


0. 

1 


• 1 
0 
0 
0 


0 

0 

0 

0 


( 5 ) 


and for a linear joint variable q. = r. we have 


Q = Q. 


0 

0 

0 

0 


0 

0 

0 

0 


( 6 ) 


U 


jkp 


the second partial derivative of the transformation matrix with 
respect to and q^. It is a 4 x 4 matrix. U sing the notations 
defined above, we have the following expression for Uj^s 

8 2 T 3 

U jkp 8q k aqp 0 Sq^rk-l/ 8q p V p-l/ j-l 






( 7 ) 
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with k, p < j. It is noted that for k = p the second partial 
derivative matrix operator for a linear joint variable r k is zero 


Vk 


= 0 


( 8 ) 


while for a re volute joint variable 0 k we have 


Vk 


1 

0 

0 

0 


0 

-1 

0 

0 


0 

0 

0 

0 


(9) 


= 4x4 "inertia matrix" (we will call it "pseudo inertia matrix") for 
body (link) "j" defined as follows: 


J. = m. 
J J 


z(' k jll + k j22 + k j33 l 


k 2 

Jl2 


k 2 
3 13 


k 2 
J 12 


2(^1 1 " k ^22 + ^33) 


j 12 


k 2 

j23 


k 2 


j23 


2( k jll + k j22' k j33) z j 


( 10 ) 


where 


x., y., *. ere defined by Eq. (2), and 
J i J 

k = radius of gyration "ip” (i, p = 1, 2, 3) of body (link) 

"j" about the origin of the coordinate frame fixed in 
the same body (link). The radius of gyration is 


12 
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defined by the corresponding member of the inertia 

tensor I.. as 
JiP 


^ X.. 

k 2 _ _Jip 
ji p m. 


(11) 


where the i, p = 1, Z, 3 indices, respectively, rep- 
resent the x, y, z axes of the Cartesian coordinate 
frame fixed in body "j". 


As seen in Eq, (10), the J. "pseudo inertia matrix" is symmetric. 

J 

It is constructed from the mass center vector Pj and the elements 
of the inertia tensor I. of body (link) "j". It is noted that the diag- 
onal terms of the upper left 3x3 partition of the J. "pseudo inertia 
matrix" are only related to the diagonal terms of the correspond- 
ing true inertia matrix I., but the diagonal terms of the "pseudo" 
and true inertia matrices are not identical. 


For an "n" degrees-of-freedom m .nipulator, Eq. (1) gives a coupled set of "n" 
nonlinear second- order differential equations which constitute the complete 
dynamic model for manipulators. 
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B . Dynamic Equations for the JPL RRP Manipulator 
Expanded in General forms 

If the algorithm given by Eq, (1) is expanded in general terms for the JPL RRP 
six degrees-of-f reedom manipulator, the following equations of motions are 
obtained: * 

D 1 1 ® 1 + D 12®2 + D 1 3 r 3 + D 14®4 + D 1 5^5 + D 16®6 
+ D 111 0 1 + D 122 e 2 + D 133 rj + D 144 04 + D 155 ®5 + D i66®6 

+ + D n3 0 1 r 3 - 1 - D u4®1®4 + D 115^1®5 + D 1 16^1^6 

+ °123®2 r 3 + D 124 e 2' J 4 + D 125®2®5 + D 126®2®6 
+ °134 r 3®4 + °135 r 3®5 + D 136 r 3®6 


+ °145®4®5 + °146®4®6 + °15t®5®6 + D 1 ~ T 1 


( 12 ) 


D 1Z # 1 + °22 § 2 + D 23 ? 3 + °24 § 4 ^ D 25 8 5 + D 26*6 
+ D 21 1^1 + D 222®2 + °233 r 3 + D 244®4 + D 255^5 + D 266®6 
+ °212®1®2 + D 213®l f 3 + D 214®1®4 " D 215 9 1^5 + D 216^6 
+ °223®2 r 3 + D 224®2®4 + D 225®2 0 5 + D 226 9 2®6 


+ D 234 r 3 0 4 + D 235 r 3 0 5 + D 236 r 3 6 6 


+ D 245 9 4°5 + D 246 e 4 9 6 + D 256 8 5®6 + D 2 = T 2 


(13) 


tin the subsequent equations 6 j and 0 j denote* respectively* the angular velocity 
and acceleration of the revolute joint variables 0 | belonging to joints 1 * 2 , 4 * 

5* 6 * while £3 and £3 denote* respectively* the acceleration and velocity of the 
linear displacement joint variable r 3 belonging to the linear joint (joint # 3 ). 

See also Figure 2 later in the text. 
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D 1 3 ® 1 + D 23 9 2 + °33 ? 3 + °34®4 + °35®5 + D 36®6 
+ D 31 1®i + D 322®2 + °333 r 3 + °344 6 4 + D 355 & 5 + D 366^6 
+ D 312®1®2 + D 313 9 l*3 + °314®1®4 + D 315®1®5 + °316®1®6 
+ D 323 9 2*3 + D 324®2®4 + D 325 9 2®5 + D 326®2 9 6 


+ °334 r 3®4 + D 335 r 3®5 + D 336 r 3 6 6 


+ D 345 e 4 e 5 + D 346 0 4 e 6 + D 356 e 5 e 6 + d 3 = f 3 


(14) 


D 14® l + D 24 § 2 + D 34 ¥ 3 + D 44®4 + D 45 6 5 + D 46 9 6 
+ D 4 h®i + D 422^2 + + D 4*4®4 + D 455 9 5 + D 466*6 

+ D 412 9 l®2 + D 413 9 l*3 4 D 414 9 l 9 4 + D 415 9 l®5 + D 416®1®6 
+ D 423 9 2^3 + D 424®2*4 + D 425®2®5 + D 426®2®6 
+ D 434 r 3®4 + D 435 r 3 9 5 + D 436 r 3®6 
+ D 445®4*5 + D 446®4®6 + °456 ®5®6 + D 4 = T 4 


(15) 
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IS 



D 15 9 l + D 25 9 2 + D 35 r 3 + °45^4 + D 55*^5 + D 56®6 
+ D 5U'I * D 522»2 + D 53 3 ' r ! + D 544°4 + D 555°! + D 566*6 


+ D 512 0 l 0 2 + D 5 13 0 1 r 3 + D 514 0 l 9 4 + D 515 0 l 9 5 + D 516 9 1 9 6 
+ D 523 0 2 r 3 + D 524 9 2 9 4 + °525 0 2 0 5 + °526 0 2 0 6 


+ D 534^3 9 4 + D 535*3®5 + °536*3 0 6 


D 545 9 4 9 5 + D 546 9 4 9 6 + D 556 9 5 9 6 + °5 = T 5 


( 16 ) 


D 16^1 + D 26 9 2 + °36®3 + °46 0 4 + D 56 9 5 + D 66 9 6 
+ D 6 1 1 ^ 1 + D 622 9 2 + D 633 r 3 + °644 0 4 + °655 0 5 + D 666 9 6 
+ D 612 9 1 9 2 + °6l3 0 l r 3 + °614 0 1^4 + D 615 9 1 9 5 + D 616 9 1 9 6 
+ D 623®2*3 + D 624 9 2 9 4 + °625 0 2 0 5 + °626 0 2 0 6 


+ D 634*3 0 4 + D 635*3®5 + D 636 r 3^6 


+ D 645 0 4 e 5 + D 646 9 4 6 6 + D 656 0 5 0 6 + °6 = T 6 


(17) 


The coefficients Dj, and in Eqs. (12) to (17) are functions of both the 
joint variables and inertial parameters of the manipulator, and can be called 
"the dynamic coefficients of the manipulator". The physical meaning and func- 
tional relation of the th. ee classes of dynamic coefficients can easily be seen 
from the defining algorithmic expression given by Eq. ( 1): 

(1) The coefficients (single subscript) are the gravity terms, func- 
tionally defined by the last term in the left hand side of Eq. ( 1). 
(Obviously, in sero gravity field the Dj coefficients are sero. ) 


16 
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(2) The coefficients (double subscript) are related to the acceleration 
of the joint variables; they are functionally defined by the first term in 
the left hand side of Eq. (1). In particular, for i = j, D„ is related to 
the acceleration of joint "i" where the driving torque T. (or force F^) 
acts, while for i i j is related to the reaction torque (or force) 
induced by the acceleration of joint "j" and acting at joint "i", or vice 

versa. (It is seen from Eqs. (12) to (17) that D.. = D... ) 

^ J J ^ 

(3) The coefficients D„ p (triple subscript) are related to the velocity of the 

joint variables; they are functionally defined by the second term in the 

left hand side of Eq. (1). The last two indices (jp) are related to the 

velocities of joint variables "j" and "p" whose dynamic interplay 

induces a reaction torque (or force) at joint "i". Thus, the first index 

(i) is always related to the joint where the velocity- induced reaction 

torques (or forces) are "felt". In particular, for j = p, Djjj is related 

to the centripetal force generated by the angular velocity of joint "j" 

and "felt" at joint "i", while for j i p D^ p i® related to the Coriolis 

force generated by the velocities of joints "j" and "p" and "felt" at 

joint "i". It is noted that for a given "i" we have D.. = D. . which is 

t l JP *PJ 

apparent by physical reasoning.' 

As seen, Eqs. (12) to (17) are six coupled, nonlinear, second-order differential 
equations describing the dynamic behavior of the JPL RRP manipulator. For a 
given set of applied torques Tj (i s 1, 2, 4, 5, 6) and force as a function of 
time, Eqs. (12) to (17) should be integrated simultaneously to obtain the actual 
motion of the manipulator in terms of the time history of the joint variables 0j, 
0 2 » r^, 0^, 0g, 0£. Then the time history of the joint variables can be trans- 
formed to obtain the time history (trajectory) of the hand motion by using the 
appropriate transformation matrix described in the footnote on page 9. Or, 
if the time history of the joint variables (together with the time history of their 


TThe symmetry of the two dynamic coefficients, Djj = Djj and Djjn = Djpj can 
easily be seen from the defining equation, Eq. (1), by noting that 


Trace (ABC T ) = Trace (CBA T ) and U jkp a U jpk 

where B is a symmetric matrix, while A and C can be two general (non- 
symmetric) square matrices. 
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acceleration and velocity) is known ahead of time (for instance, from a 
trajectory planning program, see Refs. 1, 2 and 3), then Eqs. (12) to (17) can 
be utilized to compute the torques (T^, i = 1, 2, 4, 5, 6) and force as a 
function of time which are required to produce the particular planned (or known) 
manipulator motion. The Stanford manipulator control scheme (Ref. 7) utilizes 
the latter procedure. 

In order to precompute torques and forces for a given manipulator motion, or 
to obtain the actual manipulator motion for given torques and forces (or, in 
general, to perform manipulator dynamic behavior and control system analysis 
and design), Eqs. (12) to (17) as stated cannot be used without knowing the 
explicit functional form (or, alternatively, the time history) of the dynamic 
coefficients Dj, D„, D^. Eqs. (12) to (17) in the stated form, however, bring 
out an important point: in the case of simultaneous motion of several joints, the 
motion at one joint has a dynamic effect on the motion at other joints, and the 
torque (or force) applied at one joint has a dynamic effect on the motion at other 
joints . Since the dynamic coefficients are dependent on the values of the joint 
variables, the effect of dynamic coupling between motions at different joints will 
depend on the actual manipulator link configuration during motion. 

In order to facilitate further reference in the dynamic and control system analy- 
sis of the JPL RRP manipulator, the lengthy and complex form of the dynamic 
equations, Eqs. (12) to (17), is brought into a more compact and structured 
r epr e sentation. 

(1) The gravity terms Dj are expressed by a six- dimensional column 
vector denoted by 


rn 1 






( 18 ) 
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(2) The acceleration- related coefficients are expressed by a 6 x 6 
symmetric matrix denoted by E^: 




11 

D 12 

°13 

°14 

D 1 5 

°16 

12 

D 22 

D 23 

D 24 

D 25 

D 26 

13 

D 23 

D 33 

D 34 

D 35 

D 36 

14 

D 24 

D 34 

°44 

°45 

°46 

15 

D 25 

D 35 

D 45 

D 55 

D 56 

16 

D 26 

°36 

D 46 

D 56 

D 66 


(19) 


Let the acceleration of the six joint variables be expressed by a six- 
dimensional column vector denoted by q: 

8 . 




8 , 


( 20 ) 


JPL Technical Memorandum 33*669 


19 


Thus, all 36 acceleration- related terms in Eqs. (12) to (17) can be 
written in the compact matrix- vector product form: 


*A = V 


( 21 ) 


(3) The velocity- related coefficients in each of the six equations, Eqs, (12) 

to (17), can be expressed separately by a 6 x 6 symmetric matrix 

denoted by D. v and defined in the following way: 

x » v 


D — 

1.V" 


2D ill 

D i 1 2 

D i 1 3 

D. . . 
il4 

D i 1 5 

D..,l 

xl6 

D i 1 2 

2D i22 

D i23 

D i24 

D i25 

D i26 

D il3 

D i2i 

2D i33 

D i34 

D i3 5 

D i36 

D il4 

D i24 

D i34 

2D i44 

D i45 

D i46 

D i 1 5 

D i25 

D i35 

D i45 

2D i55 

D i56 

D il6 

D i26 

D i36 

D i46 

D i56 

2D i66 


Let the velocity of the six joint variables be expressed by a six- 
dimensional column vector denoted by q: 




( 22 ) 




(22. a) 


6 , 


e. 


20 


JPL Technical Memorandum 33-669 


Then the 21 velocity- related terms in each of the six equations, Eqs. 
(12) to (17), can be expressed separately in the following compact 
matrix- vector product form: 


|q T D iV t (23) 

where the superscript T denotes the transpose of the column vector q^, 
and subscript "i" refers to the joint (i - 1, • • • , 6) at which the 
velocity-induced torques (or forces) are "felt". 

The expression given by Eq. (23) can be regarded as a component in a 
six- dimensional column vector denoted by dyj 


= 


' * T • 

« D 1,V« 


q d 2jV , 


. T ^ 

q D 3, v q 


juT 

1 tu.v'i 


.u 

q D s,v < i 


(24) 


■ 
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Let the torques T^, T T^, T^, and force F^ applied at joints 
i = 1 , • • • , 6 be expressed by a six- dimensional column vector denoted 

b y ^XF* 


T 


1 


d TF = 



T 


5 


(25) 


Then the six, coupled nonlinear differential equations, Eqs. (12) to 
(17), describing the dynamic behavior of the JPL RRP manipulator can 
be expressed by the following compact and structured vector equation: 


d TF = D A q + d V + d G 


(26) 


where all the necessary functional and operational definitions are pro- 
vided previously in this Section. 

It is noted that some of the dynamic coefficients Dj, D.^ and in 
Eqs. (12) to (17) are zero for different reasons, as the explicit coeffi- 
cient evaluation will show it in the subsequent Sections. In general, 
some of the dynamic coefficients in a full scheme of manipulator 
equations of motion (like the scheme of Eqs. (12) to (17)) will be, or 
can be zero for the following physical reasons: 

e The particular kinematic design of a manipulator can elimi- 
nate some dynamic coupling (Dy and coefficients) between 
joint motions. 
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• Some of the velocity- related dynamic coefficients have oniy . 

dummy existence in the general scheme; that is, they are 

physically non-existent. (For instance, the centripetal force 

will not interact with the motion of that joint which generates 

it, that is, = 0 always; however, it can interact witn 

motions at the other joints in the chain, that is, we can have 

D... t 0.)* 
jn 

• Due to particular variations in the link configuration during 
motion, some dynamic coefficient r may attain zero values at 
particular instants of time. 

The equations of manipulator motion given by Eqs. (12) through (17) are 
symbolic differential equations; they include all inertial, centripetal, Coriolir, 
and gravitational effects in symbolic form. (Symbolic in the sense that the 
D., Djj, ^ijp coe ffi c i en * s are n °t specified explicitly. ) In the subsequent 
sections the inertial (all D.. and some D„) as well as the gravitational (D.) 
coefficients will be explicitly specified and evaluated. 


*The relation between the general dynamic algorithm, Eq. (1), and the gener- 
ally zero dynamic coefficients in the scheme of dynamic equations, Eqs. (12) 
to (17), are discussed in the following memo: 

Lewis, R.A. , "Some RRP Manipulator Dynamic Considerations Impacting 
Planning Program Implementation, l' JPL Guidance and Control Technical 
Memo 343-183, 13 March 1973. 

Further, the simplifications of the general dynamic algorithm developed in 
Appendix D of this report explicitly show both the generally zero dynamic 
coefficients and the symmetries between some of the generally existing 
dynamic coefficients. 
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IV. RESTRICTED DYNAMIC MODELS 


To perform dynamic behavior and control system analysis for the JPL RRP 

manipulator, functionally explicit expressions must be derived for the . .1; nipu- 

lator dynamic coefficients D., D.., and D.. defined in the previous Section. 

1 ij ijp 

As seen from the defining •quations for D., D.., and D.. , the derivation of 

i i j i j P 

functionally explicit expressions for the dynamic coefficients for a six-degree 
of-freedom manipulator is a tremendous task. Furthermore, the resulting 
expressions can be rather complicated so that the coefficient equations can 
easily get out of hand. Thus, to keep the analytic task manageable, some 
dynamically meaningful restrictions will be introduced into the general dynamic 
model of the TPL RRP manipulator. The different types and classes of 
restricted dynamic models are briefly described in the following subsection. 


A. Alternative Model Restrictions 

Active dynamic coupling between motions at different joints exists only when 
several links are moving relative to each other simultaneously. (Note that 
there is always a passive dynamic coupling between the motion at joint "i" and 
the non-moving joints, "felt" by the motor brake of the non- moving joints.) 

Thus, an obvious dynamic restriction for analytic purposes is to consider the 
motion only at one joint "i" at a given time so that the positions at the other five 
joints are kept fixed in a known configuration (representing a fixed, known load 
for joint motor "i") while there is a motion at joint "i". 

Another meaningful dynamic model restriction for analytic purposes is to con- 
sider the simultaneous motion at a restricted number (a subgroup) of joints, 
while the positions at the other joints are kept fixed in a known configuration. 

In that case, the dynamic interaction only between moving links is of interest 
for analysis. Two dynamically important subgroups of joints can immediately 
be identified for the JPL RRP manipulator; the first three joints (i = 1, 2, 3) , 
and the last three joints (i = 4, 5, 6) . 

Another important dynamic model restriction is to consider only the acceleration- 
related and gravity terms in the equations of motion. This restriction can mean- 
ingfully be combined with the subgroup restriction described above. It is noted, 
however, that, for general motions, the dynamic importance of the 
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velocity- dependent terms in the equations of motion can only be evaluated by 
an explicit evaluation of the velocity- dependent dynamic coefficients D.^. 

B. Applications of Dynamic Model Restrictions 

Though the general motions for the JPL RRP manipulator are considered to 
consist of a coordinated, simultaneous motion of several or all joints, the 
dynamic model restrictions described in the previous subsection have 
important applications. First , they considerably contribute to an explicit 
insight into the dynamic behavior of the manipulator under different motion 
conditions. Second , they contribute to the development and design of a reliable 
and simple control system. Third , they can profitably be used to simulate or 
check out different elements and aspects of the manipulator control system in 
real time. 

The main advantage gained by the dynamic model restrictions in the analysis is 
that the introduced simplifications are related to well-defined and controllable 
a s sumption s. 
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V. RESTRICTED DYNAMIC MODEL FOR THE FIRST 
THREE LINK- JOINT PAIRS 

The first three links of the JPL RRP manipulator are called (see footnote, 
page 9) 

Link 1: post 
Link 2: shoulder 
Link 3: boom 

The associated joint variables are, respectively, 0^, Q^, r^. The Cartesian 
reference frames fixed in the first three links are subscripted by 1, 2, 3. 

Figure 2 shows the actual link, reference frame, and joint variable relations. 

As described in general terms in footnote, page 9, the values of the two revolute 
joint variables (01 and 6z) and the linear (sliding) joint variables (r 3 ) are mea- 
sured in the following sense: 

= the angular displacement of the X^ axis relative to the Xq axis, posi- 
tive in the right hand sense about the Zq axis; 

02 = the angular displacement of the X 2 axis relative to the X^ axis, posi- 
tive in the right hand sense about the Zj axis; 

r^ = the linear displacement of the origin of the X^Y^Z^ reference frame 
relative to the origin of the X 2 Y 2 Z 2 reference frame, measured along 
the Z 2 axis (always positive). 

As seen in Fig. 2, the first three link- joint pairs constitute the main "arm- 
positioning" mechanism, and the associated three driving motors carry the 
heaviest loads. Thus, it is dynamically meaningful and important to consider 
the first three link-joint pairs by themselves as a subgroup, temporarily sep- 
arated from the motions at the last three (wrist) joints. 

The definition of "restricted dynamic model for the first three link-joint pairs" 
treated in this Section is the following: 

• The last three (wrist) joints are at rest in a known configuration. (For 
instance, an analytically convenient, "known" configuration for the 
three wrist joints is the one seen in Fig. 2.) 

e There can be simultaneous motion at the first three joints, while the 
wrist joints are at rest. 
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ire 2. Reference Frames for Link-Joint Pairs of Arm 


The restriction has the following dynamic meaning and significance: 

• The last three (wrist) links, together with an object in the hand, form 
a constant (not time- varying!) load as seen by the first three joint 
motors. 

• There will be active dynamic coupling between motions at the first 
three joints only. 

The last point has the consequence that in the dynamic coefficient matrices 
and D. v (see Eqs, (19) and (21)) only the upper left 3 by 3 partitions are of 
interest, and the state (or time) variation of three gravity terms (D^, D^> D^, 

— see Eq. (18) — ) should only be considered. 

In ihe "restricted dynamic model for the first three link-joint pairs" described 
above, the values of the mass center vector and "pseudo inertia matrix" for the 
first two links ( p^, P2» Jj, given in Appendix B at the end of this memo are 
unchanged. The values of the mass center vector and "pseudo inertia matrix" 
for the third link (Pj and J^) as given in Appendix B, however, should be modi- 
fied according to the fixed configuration of the wrist structure. That is, the 
inertia properties of the wrist structure should be properly added to the values 
of and Jj. For the configuration seen in Fig. 2 the modification is simple, 
since the wrist structure only represents a symmetric, straight extension of the 
boom. In the subsequent evaluation of restricted dynamic coefficients, the wrist 
structure configuration seen in Fig. 2 is assumed. 

In this memo, only the gravity and acceleration- related terms are explicitly 
evaluated in the "restricted dynamic model for the first three link-joint pairs". 
The velocity- related terms will explicitly be evaluated in a subsequent memo. 

To distinguish between dynamic coefficients belonging to the dynamic model 
restricted to motions at the first three joints, and those belonging to all joint 
motions, we introduce the following notation: 

$ £ £ 

Dj , Dy, = for motions restricted to the first three joints; 

Dj, Djj, s for motions at all joints. 

In the subsequent equations, the "star" (*) distinction will also be used for the 
inertial parameters (related to link 3) which specifically belong to the restricted 
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model* The following short notation will also be adopted in the equations for the 
dynamic coefficients: 


sin 0* 4 s0. 

1 1 

cos 0. 4 c 0 . 

i i 

sin 2 e. ^ s 2 e. 

1 1 

2 . A 2. 
cos 0. * c 0. 
i i 


The explicit matrix functions for the partial derivative matrices which are 
needed in the explicit evaluation of the dynamic coefficients are listed in 
Appendix A at the end of this memo. 

A. Gravity Terms 

In the explicit evaluation of the gravity terms it is assumed that the field of 
gravity is parallel to the Zq direction of the base coordinate frame, or in other 
words, the manipulator post stands gravitationally vertical. Thus, we will use 
the following value for the 1 by 4 gravity vector: 

G = [0, 0, -g, 0] (27) 


where g = acceleration of gravity. 

1. For joint fi t 

From the defining equation we have: 

Dj = m l GU il p i + "*2^21^2 + m 3 CU 31 P 3 


The evaluation of Eq. (28) yields: 



(28) 


(29) 
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Eq 4 (29) is immediately apparent by simple physical reasoning since, by 
assumption, the rotation axis of joint motor #1 is always parallel to the field of 
gravity, hence joint motor #1 cannot "feel" any gravity torque. This physical 
circumstance corresponds to zero values for the vectors GU^, GU^ and GUjj 
in the defining formula, Eq. (28), since the third row of the Uj U *nd 
matrices is zero. (See Eqs. (A.l, A. 2 and A. 3) in Appendix A. ) Clearly, if the 
G vector would contain components other than G - -g, that is, if the manipu- 
lator post would be tilted relative to the local field of gravity, then D j would be 
different from zero. This is easily seen also from the structure of the U^, 
andU^j matrices. 

2. F or joint #2: 

From the defining equation we have: 



m 2 GU 22 P 2 + m 3 GU 32 P 3 


(30) 


The evaluation of Eq. (30) gives: 



Eq. (31) is also apparent by simple physical reasoning. 


(31) 


It is noted that Eq. (31), expressing the gravity torque "felt" by the motor of 

joint #2, is already a balanced equation with respect to the sliding of the boom 

relative to the rotation axis of the motor of joint #2. The net ("balanced") value 

of the gravity torque acting on the motor of joint #2 is simply expressed in 

$ $ 

Eq. (31) by the term (1^ + r^) since a (necessarily) negative constant , 

while r^ is (necessarily) a positive variable. 


3. For joint #3 : 

From the defining equation we have: 


D 3 s "4 OT 33*3 


(32) 
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The evaluation of Eq. (32) yields: 



- m 3 gc e 2 


(33) 


which is again apparent by simple physical reasoning. Eq. (33) expresses the 
accelerating (or decelerating) effect of the gravity as a function of felt by the 
motor which drives the boom. 

B. Acceleration-Related Dynamic Coefficients 

Due to the symmetry of the matrix, only six acceleration- related dynamic 

coefficients should be evaluated for the dynamic model restricted to the first 

three link-joint pairs: three "diagonal", and three "off-diagonal" coefficients. 

* 

The "diagonal" coefficients (D..) are related to the total inertia "felt" by the 
motor acting at joint "i", due to the motor's own acceleration. The "off- 
diagonal" coefficients (D„, i i j) are related to the dynamic interaction 
(reaction force or torque) caused by accelerations at joints "i" and "j". For 

Jpt •• 

instance, the term D^B^ expresses the reaction torque "felt" by the motor of 
joint #1 due to the acceleration §2 at joint #2. It is noted that, because the 
symmetry = D?., the same coefficient will appear in the term D^Sj 
which expresses the reaction torque felt by the motor of joint #2 due to the 
acceleration 0j at joint #1. 

1. Diagonal Coefficients D*^, D^, 

From the defini'^ equation we have:^ 


d !i ■ Tr l 

(°n J i u n) 

+ T 'Kl J 2 U Il) + 

(34) 

°22 * Tr ( U 22 J 2 U ? 2 ! 

! + Tr ( U 32 J X 2 ) 

(35) 

D*j = Tr(u„J* 3 uJ, 

1 

(35. a) 


T Here and in subsequent equations In this memo the "Trace" operator will be 
abbreviated by "Tr". 
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After considerable algebra and trigonometric simplifications, the following 
explicit expressions are obtained from Eqs. (34), (35) and (35. a): 



(37) 

(38) 



Dealing with linear motion at joint #3, Eq. (38) ia immediately obvious. The 
physical meaning of Eqs. (36) and (37) is also clear by interpreting the compo- 
nents step by step. 

jft t V 

By examining the explicit expressions for Djj, and given by Eqs. (36) 
to (38). the following general notes should be made: 

e D* j is a function of some inertial properties of mj. m 2 « m^ and the 
variations in ^ and r y (It is obviously independent of the variation 
in 8j. ) Furthermore, the constant displacement parameter r ^ also 
contributes to the value of D*j. 

£ j|l 

e ie a function of some inertial properties of m 2 * m^ and the varia- 

tions in ty (It is obviously independent of the variations in 0j and 0£. ) 

e In general. D u can be a function of the inertial properties of masses 
starting with m^ and ending at the mass in the hand, and can be a 
function of variations ia joint variables starting at joint l+l and end- 
ing at the last joint at the hand. 
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The actual dynamical (or load) significance of the different components in 
Eqs. (36) and (37) can only be determined if the numerical values of the differ- 
ent inertial parameters involved in Eqs. (36) and (37) are known. 


2. Off-Diagonal Coefficients D^, ^* 3 ' ^23 
From the defining equation we have: 

D Iz = T '( U 22 J 2 U 2 l) + Tr ( U 32 J Ml) 

D n ■ Tr ( u 33 J *3 u Ii) 

°23 = T '( U 33 J 3 U Tz) 


(39) 

(40) 


(41) 


After some algebra and trigonometric simplifications we find the following 
explicit expressions from Eqs. (39) to (41): 







(42) 

(43) 

(44) 


The physical meaning of the expressions given by Eqs. (42) to (44) has been 

explained previously. Again* the actual dynamic (or load) significance of the 
e e 

Dj^ and forms can only be evaluated if the numerical values of the pertinent 
inertial parameter a are known. 
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VI. COMPLETE DYNAMIC COEFFICIENTS FOR 
ALL SIX LINK-JOINT PAIRS 


In this section we consider the JPL RRP manipulator in an unrestricted state 
of motion compatible with structural, power, performance, instrumentation, 
work space, and other possible constraints. It is now assumed that several 
or all six links can move (or will move) relative to each other simultaneously 
when the manipulator performs a given task. In other words, we consider now 
the dynamic coefficients in the manipulator equations of motion as functions of 
all possible manipulator motions. This amounts to specifying the complete 
state functions for the dynamic coefficients in explicit terms. The complete 
state functions for the dynamic coefficients relate the values of each individual 
coefficient in explicit function terms to all pertinent link inertia characteristics 
and geometric parameters, as well as to all possible configuration of the manip- 
ulator (that is, to all possible variations in all pertinent joint variables). 

In this memo, the complete state functions will be evaluated only for the follow- 
ing dynamic coefficients: the six gravity terms in Eq. (18), and the six diagonal 
elements of the matrix in Eq. (19); that is, the six acceleration-related 
uncoupled terms in the dynamic equations. The off-diagonal acceleration- 
related coefficients, as well as the velocity- related coefficients will be treated 
in subsequent memos. 

The explicit matrix functions for the IL^ partial derivative matrices which are 
needed in the explicit evaluation of the dynamic coefficients are listed in Appen- 
dix A, while the six "pseudo inertia matrices" are listed in Appendix B at the 
end of this memo. The trigonometric short notations specified in the previous 
section will also be used in this Section. Additional short notations applied in 
this Section are: 


sin (0. + 0.) £ sOj + 0.) 
cos (0 £ 1 0^ - c(0 i + 0d 
sin 2 (8 t + 8j) ^ s 2 (0 i + 0j) 
cos 2 (0j + 0^) - c 2 (0 t + 0j) 
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As in the previous Section, reference should be made to Fig. 2 which shows the 
actual link, reference frame and joint variable relations. The sense of mea- 
surement for the 9j, 0^ and r^ variables has been specified in the previous 
Section. As described in general terms in Ref. 1, the last three revolute 
(wrist) joint variables, 0^, 9_, and 0^, are measured in the following sense: 

0^ = the angular displacement of the axis relative to the axis, 
positive in the right hand sense about the axis. 

0(. = the angular displacement of the X^ axis relative to the X^ axis, 
positive in the right hand sense about the axis. 

0£ = the angular displacement of the X^ axis relative to the X^ axis, 
positive in the right hand sense about the Z^ axis. 

A. Gravity Terms in Complete Form 

As in the previous Section, it is assumed again that the manipulator post stands 
gravitiationally vertical. That is, Eq. (27) is used for the 1 by 4 gravity vector 
G. 

1. For joint #1 : 

From the defining equation we have: 

D 1 = m l GU ll P l + m 2 GU 21 P 2 + m 3 GU 31 P 3 

+ m 4 GU 41 ? 4 + m 5 GU 51 P 5 + n^GU^ (45) 


‘the evaluation of Eq. (45) gives 



(46) 


Eq. (46) is immediately obvious for the same reason as outlined in connection 
with Dj = 0, Eq. (29)i in the previous Section. The additional remarks made 
there are also valid here. Eq. (46) simply means that the motor of joint #1 
cannot feel any gravity torque. 
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2 . For joint #2: 


From the defining equation we have: 

D Z = m 2 GU 22 P 2 + m 3 GU 32 p 3 + m 4 GU 42 P 4 

+ “ 5 GU ,2 P 5 + m 6 GU 62 P 6 ,47 > 

The evaluation of Eq. (47) yields: 



Comparing Eq. (48) to the corresponding expression for the restricted model, 
Eq. (31), it is seen that changes in the wrist configuration (that is, variations 
of the wrist joint variables 0^, 0,. and 0^) produce a gravity torque effect felt 
by the motor of joint #2 in a functionally complicated form. It is noted that 
Eq. (48) is already a balanced equation with respect to the sliding of the boom 
relative to the rotation axis of the motor of joint #2. This is true for the same 
reason as outlined in connection with Eq. (31) in the previous Section. 
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3. For joint #3: 


From the defining equation we have: 

D 3 = m 3 GU 33 P3 + m 4 GU 43 ? 4 4 m 5 GU 53 P' 5 4 m 6 GU 63 ? 6 
Evaluation of Eq. (49) yields: 

D 3 = -g( m 3 + m 4 + m 5 + m ( ) ) c0 2 


( 49 ) 


(50) 


which is physically apparent. Eq. (50) expresses the accelerating (or deceler- 
ating) effect of the gravity force as a function of ©£, felt by the motor which 

drives the boom. Eq. (50) is completely equivalent to Eq. (33) since, in fact, 

# 

m, = m, 4 m. 4 m c 4 m, . 

3 3 4 5 6 

4. For jcint #4: 

From the defining equation we have; 

°4 = m 4 GU 44p4 + rn 5 GU 54p5 + m 6 GU 64 ? 6 (51) 


Evaluation of Eq. (51) yields: 



(52) 


Eq. (52) expresses the gravity torque felt by the motor of joint #4 as a function 
of the variations in the joint angles 0 ^ • 64 . and 6 ^. 

5. For joint #5 : 

From the defining equation we have: 

D s . m 5 GU 55 ? 5 . m 6 GU &5 f 6 (53) 
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Evaluation of Eq. (53) gives: 



( 54 ) 


Eq. (54) relates the gravity torque felt by the motor of joint #5 to the variations 
of the joint angles 0^, 0^, and 0,.. 


6. For joint #6 : 

F rom the defining equation we have: 


D 


6 


m G GU 66 P 6 


(55) 


The evaluation of Eq. (55) yields: 


D 6 = 0 


(56) 


Eq. (56) is physically apparent, since the center of mass of link #6 is along the 
axis which is the rotation axis of the motor rotating link #6. It is noted that 
the hand is inertially part of link #6. 

B. Acceleration-Related Uncoupled Terms in Complete Form 

The D-.q. type terms in the dynamic equations, Eqs. (12) to (17), are called in 
this memo the "acceleration- related uncoupled terms". The notion "uncoupled" 
is meant to signify that the inertia load felt by the motor of joint "i" is being 
dynamically generated by the acceleration of the same joint "i" (and not by the 
acceleration of some other joint "j"). The dynamic coefficients D^. belonging 
to the "acceleration- related uncoupled terms" are the six diagonal elements of 
the D. matrix given by Eq. ( 19). Thus, the dynamic coefficients D.. are 
related to the total inertia felt by the motor acting at joint "i", due to the 
acceleration of the same joint. 


■ 
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In this subsection the complete state functions for all six D„ dynamic coefficients 

will be evaluated. The complete state function soecifies the value of in 

terms of all pertinent inertial and geometric parameters of all six links, as well 

as in terms of all six pertinent joint variables. Since the manipulator dynamic 

model is now not restricted to f he first three link- joint pairs, it can be expected 

that the resulting expressions for D.. will be considerably more complicated 

* 11 

than the state functions for D.. treated in the previous section. It is reminded 

* 11 

that the values of D.. are restricted to variations in the first three jcint vari- 

11 

ables only. 

1 . For joint #1 : 

From the defining equation we have: 


D 11 ' Tr ( U ll J l U n) + Tr ( U 2 l J 2 U ?i ) + Tr ( U 31 J 3 V u) 


+ Tr ( U 41 J 4 U Jl) + Tr ( U 51 J 5 U 5l) + Tr Kl J 6 U 6 T l) < 57 > 
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After lengthy algebra and trigonometric simplifications 

Eq. (57) yields the following state function for ir 


the evaluation of 
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The first three terms in Eq. (58) are identical to the terms for D, . given by 

1 1 2 2 

Eq. (36), except that in Eq. (58) the "star” (*) is removed from m^> ^333 

and z^. These four "unstarred” values in Eq. (58) refer to the third link only. 
The last three, long, and complex terms in Eq. (58) — that is, those multiplied 
by m^, m^, and m^ — account for the configurational inertial effects of the 
motion of the three wrist joints, joints #4, #5, and # 6 , as "seen” by the 
term in the dynamic equation for joint #1, Eq. (12). Alternatively, if the con- 
figuration of the wrist joints is fixed during motion of joint # 1 , then the m^ # m^, 
m^ terms in Eq. (58) ail together represent only one compounded, constant 
inertia number belonging to the particular, fixed configuration of the wrist joints. 

This constant inertia number can be used for D,, to replace the "starred 1 ' (#) 

2 2 — . 11 

values of m^» ^ 322 ’ ^333* an< * z 3 * n ^9* simply by adding this constant num- 

ber to Eq. (36); in that case, the "unstarred" m^, ^ 322 ’ ^ 333 ’ an< * *3 va ^ ue8 
Eq. (36) refer to the third link only. 


It is seen from Eq. (58) that the configurational inertial effect of the different 
links as "felt" at joint #1 becomes more and more complex as we move toward 
the free end (the hand) of the chain of links. The most complex configurational 
inertial contribution comes from the last (#6) link. 


It is noted that further trignometric simplifications would be possible for the 
m^, nig, m^ terms in Eq. (58). The simplifications are not carried out, how- 
ever, since they do not seem to illustrate major physical points. 


2. For joint #2: 

From the defining equation we have: 


D 22 * Tr ( U 22 J 2 U 2 T 2) + Tr ( U 32 J 3 U 32 ) + Tr ( U 42 J 4 U D 


* T' ( Wb) + Tr ( 0 62 J 6°62 ) 


(59) 
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Again, after lengthy algebra and trigonometric manipulations, the evaluation of 
Eq. (59) gives the following state function for D ?? : 


°22 m 2 k 222 


+ m 3 [ k 311 + r 3 (2x 3 + r 3 ) ] 


+ m 4 k 4H c e 4 + k 433 s 0 4 + r 3^ r 3 ' 2y 4*] 


+ [ k 5ij c ®4 C ®5 k 522 S ®4 k 533 c ®4 S r 3^ r 3 + ^ ,z c ) c ^c ) ) 


+ m 6 i k 6ii [^V c 2 e 6 )(s 2 e 4 c 2 e 5+ s 2 e 5 - c 2 e 4 ) 


2 2 1 

+ c0^(c0^ - 4 s© 4 c0 4 s0^c 0^) + s 0 4 s ©(. j 


*\ y izz [t^8 6 - » 2 e 6 )(s 2 e 4 c 2 e 5 ♦ 5 2 e 5 - c 2 e 4 > 


+ c0^(c0^ 4- 4 s0 4 c0 4 s0^c0^) + s 2 0 4 s 2 0 5 ] 


+ k 633 c ® 4 8 ®5 + [ r 3 ^ 2 r 6 c ®5 + + r 6^ 8 ® 4 8 ®5 + c 

+ 2 z 6 [( r 3 + r 6 c 0 5 ) c 0 5 + r 6 s 2 0 4 s 2 e 5 ] J 


The first two terms in Eq, (60) are identical to the terms for D ^ given by 
Eq. (37), except that in Eq. (60) the "star" (*) is removed from m^, k 2 jj, and 
li^. These three "unstarred" values in Eq.-(60) refer to the third link only. 

The terms with m 4 , m^, and m^ in Eq. (60) account for the configurational 
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inertial effects of the motion of the three wrist joints (joints #4, #5, #6) as seen 
by the D^G^ term in the dynamic equation for joint #2, Eq. (13). Alternatively, 
if the configuration of the wrist joints is fixed during motion of joint #2, then the 
m^, nij., terms in Eq. (60) all together represent only one compounded, con- 
stant inertia number belonging to the particular, fixed configuration of the wrist 
joints. This constant inertia number can be used for to replace the 

"starred” (*) values of m^, k^^, and z^ in Eq. (37) simply by adding this con- 
stant number to Eq. (37); in that case, the "unstarred" ^ , and values 

in Eq. (37) refer to the third link only. 

It can be noted again that the configurational inertial effect of the different links 
as "felt" at joint #2 becomes more and more complex as we move toward the 
free end (the hand) of the chain of links. The most complex configurational 
inertial contribution comes from the last (#6) link. Comparing the m^, m,-, 
and terms of Eq. (60) to those of Eq. (58), it is seen, however, that joint #2 
"feels" the configurational inertial effect of the three wrist links through terms 
which are "simpler" than the corresponding terms of joint #1. 


3. For joint #3 ; 

From the defining equation we have: 


d 33 



+ Tr 


U , 3 J 3 U 3 T 3 ) +Tr(u 4 J J 4 uJ 3 ) 
( U 63 JU Ii) 


+ Tr (U 53 J 5 UJ 3 ) 


( 61 ) 


which gives 



( 62 ) 


Dealing with linear motion at joint #3, Eq. (62) is immediately obvious. (In 
fact, it can be written down without going through the transformations indicated 
by Eq. (61).) It can also be noted that Eq. (62) is completely identical to the 
expression for given by Eq. (38), since, in fact, m ^ a m j + 
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in other words, i- independent of any arm link configuration, it is a 

constant. The value of will only be changed when the hand grasps an object. 

In that case, the mass of the object should simply be added to Eq. (62), or more 
precisely, to the value of m^. 

4. For joint #4: 

From the defining equation we have;^ 

D 44 * Tr ( U 44 J 4 U L) + Tr ( U 54 J 5 U 5 4 ) + Tr < 63 > 

Evaluating Eq. (63) results in the following function: 



Eq. (64) is physically apparent, and can easily be interpreted term by term. 
The similarities and dissimilarities of Eqs. (64) and (36) are also noteworthy. 

5. For joint #5: 

From the defining equation we have:^ 

D„ = Tr (u 55 J 5 U 5 T 5 ) 4 Tr (v 6$ J 6 U*) (65) 


^See also remark at the end of this section. 
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which yields the following explicit state function: 



( 66 ) 


Eq. (66) is also apparent physically, and can easily be interpreted term by term. 
The similarities and dissimilarities of Eqs. (37) and (66) are again noteworthy. 

6. For joint #6: 

From the defining equation we have:t 


°66 * Tr ( U 66 J 6 U 6 T 6 ) 


which gives 



(67) 


( 68 ) 


Eq. (68) is obvious. In fact, it can be written down immediately without going 
through the formal transformation indicated by Eq. (67). 


Remark 

The formal definitions for Dgg, and given by Eqs. (63), (65) and (67) 

involve a great deal of unnecessary computations. By noting that only 
depends on the inertias of links #4, #5, and #6, while Dgg only depends on the 


*See also remark at the end of this section. 
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inertias of links #5, and 46 , the following computationally more convenient 
definitions can be (and have been) used for and D^,-: 


D 


•44 


Tr 


( ° T 3 K( QT 3) 


+ Tr 


( QT S T 4 ) J s( « T | T 4 



+ Tr 




4 5 6 
QT3T4T5 


K( 


4 5 6 
QT^T^T” 



D 


55 



+ Tr 


'( 


QT4T5 



In a similar manner, we can also write for 


D 


66 = 


Tr [( QT 5 K(0 T t) T _ 


But even the evaluation of this last expression for is unnecessary since 

Eq. (68) can be written down immediately. 

The mathematical derivation of the simplifications introduced here in the 
general algorithmic definition of D.. is treated in detail for all manipulator 
dynamic coefficients in Appendix D at the end of the report. 


46 


JPL Technical Memorandum 33*669 


VII. CONCLUSIONS 


Values of total link inertias and the different torque/force components acting 
at the manipulator joint drives are essential parameters for manipulator control 
system design. It is seen frc n the dynamic equations derived for the JPL 
RRP manipulator that there is no simple proportionality between torque (or 
force) acting at one joint and the acceleration of the same joint when several 
joints are in motion simultaneously. Even if only one joint moves at a given 
time, the proportionality between torque and acceleration is a complex function 
of the actual configuration of all links ahead of the moving joint, that is, of all 
links between the moving joint and the hand, including any load in the hand. 

In the case of simultaneous motion of several arm joints, the torque (or force) 
acting at each joint is the sum of a number of dynamic components which can 
be classified into four groups: (a) inertial acceleration of the joint; (b) reaction 
torques or forces due to acceleration at other joints; (c) velocity- related 
(centrifugal and Coriolis) reaction torques or forces; and (d) gravity terms. 
Obviously, the gravity terms are onl/ dependent on the relative position of the 
links, while all other dynamic components are dependent on both the configura- 
tion and the dynamic state (relative acceleration and velocity) of the links. 

The explicit state equations derived in this memo for some of the dynamic 
coefficients of the JPL RRP manipulator allow important quantitative conclu- 
sions regarding variations in total link inertias and gravity loads as seen at 
the different joint drive motors during arm motion. Further, the explicit state 
equations of the inertial (diagonal) and acceleration- related reaction (off- 
diagonal) dynamic coefficients derived for a restricted manipulator dynamic 
model allow a general quantitative evaluation of the relative importance «f some 
of the acceleration- related torque/force reaction components versus inr . ►ial 
torques /forces. 

The constant geometric and inertial parameters for the JPL RRP manipulator 
used in the subsequent evaluation are identical to those determined and 
compiled elsewhere. * (Parameter values are also listed in Appendix B.) 

♦Walker, B. , "RRP Manipulator Inertial and Mass Distribution Characteristics. ” 

JPL IOM 343-4-73-142. 28 February 1973. 

Dobrotin, B.M. . "Input Shaft Inertias fox RRP Manipulator, " JPL 
IOM 343-4-73-268, 13 April 1973. 
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A. Variations in Total Inertia at the Joints 


The total link inertias as seen at the different joints are given by the diagonal 
elements D.. of the D. matrix defined by Eq. (19). The complete state equa- 
tions for the dynamic coefficients are given by Eqs. (58), (60), (62), (64), 
and (68), These equations only refer to the mechanical structure of the manip- 
ulator. Changes in these equations due to a load held in the hand are elaborated 
in Appendix (J. 


In the subsequent evaluation of variations in total inertias we compute the 
maximum variation in with and without load in the hand as well as the mini- 
mum value of D. . without load in the hand. The assumed load is a 1. 8 kg, 

u ; 

442 cm cube, placed with its mass c enter at the origo of the hand ( X Y^, 

Z^) coordinate frame. In the computations, the constant and varying compo- 
nents of D„ are treated separately. All computed values are referred to the 
output at the respective joints, including the input inertias at the joint drives. 

As seen from Eqs. (58), (60), and (64), the variations in Dj j, & 22 ’ ^44 are 
functions of several joint variables. Thus, an analytic search for maximum 
values of Djj, D^, ^44 wou ^ i m ply the determination of hill tops of surfaces 
or hypersurfaces. Instead of this mathematical technique, we apply physical 
reasoning and select an appropriate (and allowed) set of joint variables which 
will yield the searched maximum value for D... 


1. Inertia Variations Seen at Joint #1 


The value of Djj given by Eq. (58) specifies the variations in the total inertia 
felt at joint #1 as a function of *he_ joint position vector q. 


a) Constant components of D,,: 

Input inertia at joint No. 1 

+ m l k 122 
+ 2m 2 y 2 r 2 

+ (m 2 + rrij + + mg)r 2 

Total constant 


0.953 kg-m 2 
0.255 kg* m 2 
-0. 192 kg* m 2 

0. 320 kg* m 2 

zz-sx 

1. 318 kg« m 


Variations due to changes in both link motion and load held in the hand. 
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b) Maximum variations D^ji 


Assume: 0-, - ±^0 deg (horizontal orientation u£ the boom) 

r^ - 111. 76 cm (maximum extension of the boom) 

0 4 = 0 deg (see Fig. 2) 

0^ = 0 deg (see Fig. 2) 

0£ = 0 deg (see Fig. 2) 

The last three conditions will move the mass of the wrist/hand mech- 
anism farthest from joint axis #1. Under the five conditions specified 
above, Eq. (58) gives the following components for Djj in addition to 
the constant components. 


m k 2 
2 K 211 

= 

0. 108 

kg* m' 

+ m 3 k 322 

- 

2. 51 

kg* m' 

+ m 3 r 3 (2 z 3 + r 3 ) 

= 

-0. 815 

kg* m‘ 

+ 1/2 m 4 (- k 2 n +k 2 22 




+ k «3> 

= 

0. 0002 

kg. m 

+ m 4 r 3 (r 3 - 2y 4 ) 

= 

1. 332 

kg* m 

+ ri 5 k 522 

= 

0. 003 

kg. m 

+ m 5 r 3 (2 z 5 + r 3 ) 

= 

0. 87 

kg. m 

+ m 6 k 622 

= 

0. 005 

kg. m' 

+ m 6 r 2 

S 

0.013 

kg* m 
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+ m 6 (r 6 + r 3 ) 2 
+ 2m 6 z 6 (r 3 + r 6 ) 


= 0. 96i kg- m 2 

= -0. 1 3 kg- m 2 


Total maximum inertia addition, 

with no load in the hand = 4. 857 kg. m 2 

Hence, the maximum total value of inertia felt at joint #1 with no load 
in the hand is: 


Dn, max (no load in the hand) = 1. 318 + 4. 857 

= 6. 176 kg* m 2 


(69) 


2) With load in the hand: 


Only the m^- related terms will he changed. According to 
the specifications of the load and the load's emplacement in 
the hand, we will have the following new values for the 
m^- related terms: 

2 2 
m 6 k 622 = 0.006 kg* m 


+ m 6 (r 6 + r 3 ) 2 

. 2 
+ m 6 r 2 

Total 


= 4. 307 kg* m 2 

= 0. 06 1 kg* nr> 2 

= 4. 374 kg* m 2 


It is noted that the Zm^z^fr^ + r^) term remains numerically 
unchanged* Thus, the net maximum inertia change due to 
the specified load in the hand becomes: 

4. 374 - 0. 979 = 3. 395 kg* m 2 
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Hence, the maximum total value of inertia felt at joint #1 
with the specified load in the hand is: 


D. , (with load in the hand) = 1, 318 + 4. 857 + 3. 395 

1 1, max 

= 9. 57 kg- 


( 70 ) 


c) Minimum value of D^: 


Assume: 


e. 


0 deg (vertical orientation of the boom) 
0 deg (see Fig. 2) 

90 deg (see Fig. 2) 

0 deg (see Fig. 2) 


It is noted that the condition 0^ = 0 deg will make inde- 
pendent of r^. Further, the condition 0^ = 90 deg will move 
the mass of the wrist/hand mechanism closest to joint axis 
#1. Under the four conditions specified above, Eq. ,^3) 
yields the following components for in addition to the 
constant components: 


k 2 

2 K 233 

= 

0. J 

kg. m 

.2 

m 3 333 

= 

0.006 

kg. m 

m 4 k 422 

= 

0.001 

kg. m 

m 5 k in 

= 

0.003 

kg- m 

2m 5 z 5 r 2 

S 

-0.012 

kg. m 

m 6 k 6 1 1 

s 

0.005 

kg. m 
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™6 (r 6 ‘ r Z )Z 

= 0. 004 

kg - m 

2m 6 z 6 (r 6 - r 2 ) 

= -0.008 

kg - m 


Total minimum inertia addition, with no 

2 

load in the hand = 0. 099 kg. m 

Hence, the minimum total value of inertia felt at joint #1 
with no load in the hand is: 


D, , . (no load in the hand) = l. 318 + 0. 009 

1 1, nnn' 

2 

= 1.417 kg* m 


In summary, the following ratios (relative values) can be formed for inertia 
variations seen at joint #1: 


D, , (no load in the hand) 

4. 36 


D, . . (no load in the hand) 

I i t nun 




0, , (with load in the hand) 

= 6.75 

O, , . (no load in the hand) 

1 1, mm 



(72) 


(73) 


2, Inertia Variations Seen at Joint #2 


The value of given by Eq. (60) specifies the variations in the total 

inertia felt at joint #2 as a function of the joint position vector <f. 

* 

a) Constant components of f> 22 : 


Input inertia at joint #2 
+ m 2 k 222 


+ m 3 k 3U 


Total constant 


52 


= 2, 193 kg.rn 

= 0.018 kg.m 2 

s 2.51 kg* m 2 

= 4.721 kg*m 2 
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b) Maximum variations in D^: 


fevtv . 


Assume: = 111.76 cm (maximum extension of the boom) 

64 = 0 deg (see Fig. 2) 

0 5 = 0 deg (see Fig. 2) 

= 0 deg (see Fig. 2) 

Under these four conditions, Eq. (60) gives the following components 
for D ^2 in addition to the constant components. 

1 ) With no load in the hand: 


m^r j(2zj + r 3 ) 


+ m 4 k 411 


+ m 4 r 3 (r 3 - 2 ^4 ) 
+ m 5 k 51 1 


+ m 5 r 3 (r 3 + 2zg) 


+ m 6 k 611 


+ m 6 r 3 (2r 6 + r 3 ) 

+ m 6 r 6 

+ 2m 6 z 6 (r 3 + r 6 ) 


-0. 815 

. 2 
kg- m 

0. 002 

. 2 
kg* m 

1. 332 

, 2 
kg* m 

0. 003 

, 2 
kg- m 

0.87 

i 2 

kg. m 

0. 005 

, 2 
kg* m 

0.929 

. 2 
kg. ; 

0.032 

, 2 
kg> m 

-0. 13 

. 2 
kg« m 


Total maximum inertia addition, with 


no load in the hand 


- 2.228 kg*m 


i 


t - - 
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Hence, the maximum total inertia value felt at joint HZ with no load 
in the hand is: 


(no load in the hand) = 4. 721 + 2. 228 

l* c* f ni a x 

= 6. 949 kg* m 2 


(74) 


2) With load in the hand : 

Again, only the m^- related terms will be changed. According to 
the specifications of the load and the load's emplacement in the 
hand, the following new values are obtained for the m^- related 
terms: 


m 6 k 6U 


= 0. 006 kg* m‘ 


+ m^r^(2r^ + r^) = 4. 165 kg*m‘ 


+ m 6 r 6 


= 0, 142 kg. m' 


Total = 4.313 kg*m 2 
It is noted again that the 2m^z^(r2 + r^) term remains unchanged 
numerically. Thus, the net maximum inertia change due to the 
specified load in the hand becomes: 


4. 313 - 0. 965 = 3. 348 kg*m 2 


Hence, the maximum total value of inertia felt at joint #2 with 
the specified load in the hand is: 


(with load in the hand) = 4. 721 + 2. 228 + 3. 348 

(<ibi max 

= 10. 297 kg* m 2 


(75) 
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c) 


Minimum value of D 


22 ' 


Assume: 0^=0 deg (see Fig. 2) 

e 5 = 90 deg (see Fig. 2) 
6^ = 0 deg (see Fig. 2) 


The condition 6^ = 90 deg will move the mass of the wrist/ 

hand mechanism closest and parallel to joint axis */2. It 

is noted that no assumption can be made for r^ yielding 

. ; instead, it has to be computed as follows. 

22, min 


Under the three assumptions specified above Eq. (60) yields the following com- 
ponents for D ^2 i- n addition to the constant terms: 


m 4 k 411 = 

0. 002 

. 2 
kg- m 

+ m 5 k 533 = 

0. 0004 

, 2 
kg* m 

+ m 6 k 633 = 

0. 0003 

, 2 
kg* m 

Total = 

0. 003 

. 2 
kg-m 


Further, we will also have ^-dependent terms forming a quadratic expression: 

*(r 3 ) = Ar^ + 2Br 3 


where 

A = m 3 + + mj + = 6. 474 kg 

B = m 3 * 3 - m^y^ + = -2. 7 1 kg • m 


I 


t 

i 
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The value of r, yielding . is obtained from 
3 7 e min 



2Ar^ + 2B 


°*»r 3( 


extremum 



41,9 cm 


Consequently, we have 

. 2 
kg. m 

felt at joint #2 with no load in the 

hand is: 


. = -1. 135 

w min 


Hence, the minimum total value of inertia 


D,, . (no load in the hand) = 4. 721 - 1. 135 + 0. 003 

cc, mm 

= 3. 589 kg- m^ 


(76) 


In summary, the following ratios (relative values) can be formed for inertia 
variations seen at joint #2: 


(no load in the hand) 

2Z > max - 1 95 

(77) 

D >7 . (no load in the hand) 

cc t mm 




D?? „_.,(with load in the hand) 

£tC»p n«aX * — 

1 A 

(78) 

D 22 m j n (no load in the hand) 

7 



3. Inertia Variations Seen at Joint #3 

The value of given by Eq. (62) is independent of any relative position of 
the joints. Only the mass of a load held by the hand can change the value of 
D 33 . Hence, for the specified load, we have the following ratio (relative value) 
for inertia variations seen at joint #3: 
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( 79 ) 


(no load in the hand) - Equivalent input + 4- m A + m- + m, = 

33, max M * 3 4 5 6 


. (no load in the hand) - 7. 257 kg 
jj, min 


D-,, (with load in the hand) 
33, max' ' 

D,, . (no load in the hand) 

33, min' 


9.057 
= 7. 257 * 


1.25 


(80) 


4. Inertia Variations Seen at Joint #4 

The value of given by Eq. (64) specifies the variations in the total inertia 
felt at joint #4 as a function of the relevant components of the joint position 
vector q, 

a) Constant components of D^: 

— 

Input inertia at joint #4 = 0. 106 kg- m 

2 2 
+ m 4^422 = 001 kg - m 

2 

Total constant = 0. 107 kg- m 

b) Maximum variations in D^: 

Assume: 0g = 90 deg (see Fig. 2) 

v 

It turns out that D ^ will be independent of 0^ for any value of 0^ since 
= kg £2 * or the JPL RRP manipulator resulting the identity 
2 2 2 

sin 0^ 4 cos 0^ = 1 for the k^jj terms in Eq. (64). According to the 
0,. = 90 deg condition specified above. Eq. (64) gives then the following 
components for D 44 in addition to the constant terms. 
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1 ) With no load in the hand: 


i 

r 

4 

! 


,2 

m 5 k 511 

0. 003 

kg* m 

+ m 6 k 611 

0. 005 

kg* m 

+ m 6 r 6 !2J 6 + r 6 ) = 

0. 008 

kg*m 


Total maximum inertia addition, with no 
load in the hand = 0. 016 kg* m 2 



rm 

t 


i 


Hence, the maximum total inertia value felt at joint #4 with no load 
in the hand is: 


D. , (no load in the hand) = 0. 107 + 0. 016 

ruaX 

= 0. 123 kg*m 2 


( 81 ) 


2) With load in the hand: 

Only the m^- related terms will be changed. According to the 
specifications of the load and the load's emplacement in the hand, 
we will have the following new values for the m^-related terms: 

m^k 2 jj = 0.006 kg.m 2 

+ m^r^(2z^ + r^) * 0. 118 kg.m 2 

Total « 0.124 kg.m 2 


Thus, the net maximum inertia change due to the specified load in the 
hand becomes: 

0. 124 - 0.013 = 0. Ill kg.m 2 



I : 
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Hence, the maximum total value o. inertia felt at joint if 2 with the 
specified load in the hand is: 


D aa (with load in the hand) = 0. 107 + 0.016 + 0. Ill 

tt 1 j max 

= 0. 234 kg* 


(82) 


c) Minimum value of D^: 

Assume: 6^ = 0 deg (see Fig. 2) 

According to this condition, Eq. (64) yields the following components in addition 
to the constant terms: 

m 5^533 = kg* m 2 

2 2 
+ m^k^j = 0.0003 kg*m 

Total minimum inertia addition, with 

2 

no load in the hand = 0. 001 kg • m 

Hence, the minimum total value of inertia felt at joint #4 with no load in the 
hand is: 


D 44 m j n ( n o load in the hand) * 0. 107 + 0. 001 

= 0 . 108 kg*m 2 


(83) 


In summary, the following ratios (relative values) can be formed for inertia 
variations seen at joint #4: 


D. . (no load in the hand 
D 44 min ^ no * oa< * 1 ° ^ hand) 


(84) 
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D. . (with load in the hand) 
m&x 

D.. . (no load in the hand) 

44, min' 


= 2. 17 


( 85 ) 


It is noted that the extremum (minimum and maximum) values of can also 
be determined without any assumption on 6^, since Eq. (64) is a function of 


one variable: 

D 4 

where 

a = 0.015 

, 2 
kg* m 

b = 0.001 

, 2 
kg* m 

c = 0. 107 

». 2 
kg* m 

The extremum of will 


dD 44 . 
do 5 


< 2 , 


no load in the hand 


That is. 


sin 26g (a - b) = 0 

since a i b, we must have sin 20,. = 0 which yields 6j * 0 or 90 deg. For 
0g * 0 deg we will have minimum value for °44 


D 44,mi» = b + c 1 °- ,08k » m 


while for 0g = 90 deg we will have maximum value 

D. . = a + c * 0. 123 kg* m 

44, max 
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5. Inertia Variations Seen at Joint #5 


The value of D er given by Eq. (66) specifies the variations in the total inertia 


jj 


felt at joint #5 as a function of 0c. It turns out, however, that D-,- becomes 

2 2 53 
independent of 8g since k^jj = ^£2 for the JPL RRP manipulator resulting in 

the identity sin 2 0^ + cos 2 0g = 1 for the k 2 „ terms in Eq. (66). Consequently, 

only the inertia properties of a load held by the hand can change the value of 

D,.g. Hence, we will have the following values for Dgg. 


a) No load in the hand: 


Input inertia at joint #5 

= 0. 098 

kg«m 

+ m S k 522 

= 0. 003 

kg.m 

+ m 6 k 6U 

= o.oc* 

kg. m 

+ m 6 r 6 (2l 6 * V 

= 0.008 

kg-m 

Total 

= 0.114 

kg. m 


Hence, 



( 86 ) 


b) With load in the hand: 

We will have the following new values for the m^- related terms due to 
the specified load: 

m 6 k 6ll 

+ m 6 r 6 (2l 6 + r 6 ) 

Total = 0.124 kg*m 2 


= 0.006 kg.m 2 
= 0.118 kg.m 2 
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Thus, the net inertia change due tc the specified load in the hand becomes: 


0. 124 - 0. 013 = 0. Ill kg* m 2 

Hence, the total value of inertia felt at joint #5 with the specified load in the 
hand is: 


D^r (with load in the hand) = 

D j j max 


0. 225 


kg* m 


2 


(87) 


In summary, the following ratio (relative value) can be formed for inertia 
variation due to the specified load in the hand: 


Dp., (load in the hand) 

d D , m ax 


D cc . (no load in the hand) 
do , mm 


( 88 ) 


6, Inertia Variations Seen at Joint #6 

As seen from F«q. (68), is a constant. We have then: 

2 

Input inertia at joint #6 = 0. 02 kg* m 

2 2 
+ = 0.0003 kg*m 

Total = 0.02 kg*m 2 


Hence, 



(89) 
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If the specified load is held by the hand, we will have: 


m 6 k 633 


= 0.002 


kg* m 


2 


Hence, the variation in inertia due to the specified load in the hand is 

0.295 - 0.049 = 0.002 kg* m 2 


yielding 


D, , (load in the hand) = 0. 02 + 0. 002 

bo j max 

2 

= 0. 022 kg* m 


(90) 


In summary, we have the following ratio for inertia variation due to the 
specified load in the hand: 


D,/ (with load in the hand) 

obi max 

D,, (no load in the hand) 

do, mm 


(91) 


All computed exact total inertia variations are summarized in Table 1 and dis- 
played in Figure 3. 

B, Maximum Gravity Load Variations 

The gravity load felt at the different joints as a function of the total joint posi- 
tion vector q is given by Eqs. (46), (48), (50), (52), (54), and (56). As seen 
from Eqs. (46) and (56), there is no gravity load at joints #1 and #6 since 
Dj = = 0 always, because, by assumption, joint axis #1 is gravitationally 

always vertical, and x^ = y^ = 0 even with load in the hand if the mass center of 
the load is placed at the origin of the hand coordinate frame (X^, Y^, Z^) or 
along the Z^ axis. Assuming again a (1. 8 kg) load and symmetric emplace- 
ment of the load in the hand, we compute the maximum gravity torques 
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Table 1. Variations in Total Inertias (Exact Values 


i 

a 

a 

3 

a 

T 

I 



1. 8 kg, 442 cm (4 lb, 27 in 
Symmetrically in the hand 
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Figure 3. Relative Maximum Variations in Total Link Inertias 




(or force) as seen at joints #2, 3, 4, 5, referred to the respective joint 
outputs. 

As seen from Eqs. (48), (52), and (54), D^, D^, and are functions of several 
joint variables. Thus, a mathematical search for maximum values of D^, 
and Dj. would mean to determine hill tops of surfaces or hypersurfaces. By 
physical judgement, however, an appropriate and allowed set of joint variables 
can be selected for each gravity term yielding the maximum value for D^. (It 
is noted that the minimum value of any gravity term for the JPL RRP manipula- 
tor is zero. ) 

The subsequent calculated gravity loads should be interpreted as absolute 
values. The ± polarities can be indicated according to the appropriate joint 
variable values. 

1. Gravity torque at joint #1 



(92) 


2. Gravity torque at joint #2 

a. Maximum value with no load in the hand. 

Assume: 

= ±90 deg (horizontal direction of the boom) 
r^ = 111.76 cm (maximum boom extension) 
0^=0 deg (see Fig. 2) 

0 = 0 deg (see Fig. 2) 

0^=0 deg (see Fig. 2) 
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The last three conditions will move the mass center of the wrist/hand mechanism 
farthest from joint axis #2 in a horizontal direction. Under the assumptions 
specified above, Eq. (48) will give the following terms: 


m 2 Z 2 



= 

-0.0445 

kg* m 

+ m 3 (I 3 

+ r 3 ) 


= 

2. 0072 

kg- m 

+ m 4 (r 3 

-7 4 ) 


= 

1. 201 

kg- m 

+ m 5 U 5 

+ r 3> 



0. 7423 

kg- m 

+ m 6 (I 6 

+ V 


=r 

0. 0806 

kg* m 

+ m 6 r 6 



= 

0. 5755 

kg- m 



Total 

_ 

4. 562 

kg -m 


Hence, 


D - (no load in the hand) = 4. 562 g = 44. 75 N* m 

Ct , max 


(92a) 


b. Maximum value with load in the hand : 

The m^- related terms will have the following new values due to the specified 
load in the hand: 

m 6 ( *6 + r 6 ) 

m 6 r 6 

Total, together with 

unchanged terms = 7.011 kg*m 


= 0. 5254 kg* m 

= 2. 5826 kg* m 


* > 
g = acceleration of gravity = 9. 81 m/aec 
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Hence, 


D, (with load in the hand) = 7.011 g - 68. 77 N* rr, 


(93) 


It is easily seen from Eq. (48) that for 0^ = 0 deg, 0^ = 90 deg and 0^ = 0 deg 
we will have 

D. . = 0 

2, min 


3. Gravity force at joint #3 

a. Maximum value with no load in the hand: 

It is obtained at 0^ = 0 (or 180) deg, that is, having the boom in vertical 
direction. We have then from Eq. (50): 


D.j (no load in the hand) =(6. 474 kg) g = 63. 5 N 

b. Maximum value with load in the hand : 

We will have for the specified load: 

D~ (with load in the hand) = (8. 274 kg) g = 81. 17 N 

f max 


(94) 


(95) 


Obviously, for 0£ 


± 90 deg we will have 


D 


3, min 


0 
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4 . 


Gravity torque at .joint ri 4 
a. Maximum value with no load in the hand: 

Assume: 

6^ - i90 deg 

0 4 = 0 deg 

0^ = ± 90 deg 

Equation (52) yields then the following terms: 

= 0. 0359 kg- m 
m & ("z^ + r^) = 0,0801 kg. m 

Total = 0. 1 16 kg. m 


Hence, 


D. (no load in the hand) = 0. 116 g = 1. 138 N-m 

4, max 


(96) 


b. Maximum value with load in the hand : 

The m^- related term will have the following new value due to the specified 
load in the hand: 


m 6 (z 6 + V 


= 0. 525 kg-m 


Hence, 


D 4 mwc (with load in the hand) = 0. 561 g = 5. 503 N • m 


(97) 
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Obviously, for 0^ = 0 deg we have 


D 


4, min 


0 


5. Gravity torque at joint #5 
a. Maximum value with no load in the hand: 
Two sets of assumptions can be made: 


= ±90 deg 
© 4 = ±90 deg 
0^ = 0 deg 


©2 = 0 deg 
0j. = ±90 deg 


Then, from Eq. (54) we will have: 

= 0.0359 kg.m 
+ m^(z^ + z^) = 0. 0801 kg.m 

Total = 0.116 kg.m 


Hence, 


D c (no load in the hand) = 0. 116 g = i. 138 N* m 

o , max 


(98) 


b. Maximum value with load in the hand : 

The related term will have the following new value due to the specified 
load in the hand: 


+ r^) = 0. 525 kg* m 
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(with load in the hand) =0. 561 g - 5. 503 N*m 


(99) 


I T ence, 



As seen from the previous equations. 


D. = D, 

4, max 5, max 


6. Gravity torque at joint #6 



( 100 ) 


It is noted that Eq. (100) is only true here because of the assumption that 
x 6 = y 6 = 0 even with a load in the hand. Suppose, however, that the mass 
center of the load is off from the origin of the hand coordinate frame so that 
the net result is, for instance, x^ = 1 in. In the case of a 1.8 kg load this will 
produce 0. 58 N* m gravity torque at joint #6, for instance, for 0^ = 0 deg, 

= = ^0 deg con fi8 urat i° n as seen from Eq. (C. 4) in Appendix C. 

All computed maximum gravity load variations at the different joints are sum- 
marized in Table 2. To complete the summary. Table 2 also shows the maxi- 
mum gravity load variations referred to the motor shaft together with motor 
stall torque and gear ratio. 


C. Relative Importance of Inertial Torques/Forces Versus Acceleration- 
Related Reaction Torques/Forcea 


The explicit state equations of the inertia terms and acceleration- related reac- 
tion torques /forces derived in Section V for the first three link- joint pairs of 
the JPL RRP manipulator can be utilized for a general quantitative evaluation 
of the relative importance of the related dynamic components in the torque or 
force equations. 


As seen from the state functions of D,, and D.'. developed in Section V, we 


*ii ij 

have the following acceleration- related non-zero terms in the torque/force 
equations for the first three link-joint pairs: 


D 11 6 1 + D 12 ®2 + D 13 r 3 + 


= T 


1 


( 101 ) 
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( 102 ) 


D 12 6 l + °22 0 2 + 


D 13 9 1 + °33 r 3 + 


= F, 


(103) 


Using Eqs. (36) through (38) and (42) through (44) which state the respective 

functions for D.\ and D. we form the following ratios: 
ii ij ® 


R i = 


12 


’ (a 6 + a 7 r 3 )c0 2 


D 


11 


21 2 , 

*2 ' *3*3 ' “43. 


a, + a, + a,r, + a.r. Is 0. + a.c 0. 


(104) 


R 2 = 


'13 


- V 0 2 


=:* r 2 1 2. 2„ 

D 11 a l + l a 2 + a 3 r 3 + a 4 r 3 J 8 C 2 + a 5 C 6 ? 


(105) 


R - ^ 

3 ' d* 
22 


- (a 6 + a ? r 3 ) c6 2 
a 8 ' a 3 r 3 + a 4 r 3 


(106) 


R. = 


13 

>* 

i 33 


. a 7 .e 2 


(107) 


where a^, *•*•*, are constants with the following values (determined by 
using the appropriate "starred" values for the ine .ia of the third link having 
the wrist configuration as shown in Fig. 2 and referring inertias to the output): 

a t = 1. 334 kg.m 2 

a 2 * 2.635 kg.m 2 

= -5.5 kg.m 

a 4 = 6.474 kg 

» 5 * 0.108 kg*m 2 
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a 7 

a 8 

a 9 


-0.453 kg.m 2 
1.05 kg • m 
4. 74 Wg •m 2 
7. 26 kg 


The maximum (absolute) value of the ratios specified by Eqs. (104) through (107) 
is obtained when the nominator has maximum (absolute) value and the denominator 
has minimum (absolute) value. 

For the ratio R, the maximum value is obtained for 0, = 0 deg and r, = r, 

1 2*33, max 

= 111.76 cm. These conditions give: 


a 6 + 44a 7 


‘1, max jaj + a^ 


= 0.5 


(10G) 


The maximum value of requires special consideration, 
and rj = 50. 8 cm we have 


2, max 


| *1 + a 2 + a 3 r 3 + a 4 r 3| 
0. 0037 cm' 1 


For 0£ = 90 deg 


(109) 


For the ratio R^ the maximum value will occur when ©2 = 0 deg and 
r^ = 111.76 cm,* These conditions give: 


l 3 f max 


*6 + 44 »7 


» g + 4 «. } + ( 44) 2 « 4 


= 0.11 


( 110 ) 


This r 3 value can be obtained by computing r 3 00 timum from the condition 
dR 3 /dr 3 = 0 for ® 2 = 0 deg. ' ^ 
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For the ratio the maximum value is obtained when 0^ - 90 deg. This gives: 


R 


4 


, max 



14. 45 cm 


( 111 ) 


An examination of Eqs, (108) through (111) for the relative ratios leads to 
interesting conclusions elaborated briefly below. 

Equation (108) shows that for J = j ^ j anc * the specified configurational 
conditions, th^ reaction corque felt at joint H due to the acceleration at 
joint #2 will be ?C% of the inertial torque at joint #1. Figure 4 depicts the 
ratio Rj as a function of 0^ for r^ = 111. 8, 81. 3, 50. 8 cm, respectively. Of 
course; some of the upper part of the r^ =■ 81.3 cm and = 50 8 cm v .rves 
on Fig. 4 are unrealizable for the JPL RRP breadboard, since some segments 
of the upper part of these two curves imply that the boom hits the vehicle plat- 
form or a wheel, depending on the value of 0 j. Figure 4 is intended to 
illustrate the conditions under which the two torques 

D nV D tz»2 * D m'«1 +R 1 S 2 ) < 1I2 > 

can be approximated by D*.0j. As seen from Eq. (112), the validity of this 

• i « •• 

approximation depends on the magnitude of R^O^ relative to Uj. It is noted that 
the sum (8^ + can also attain zero value. 

The ratio has dimension cm’ ^ since it is related to the sum of the two 
torques 

D I. s i +D » i; J ■ D n<*i + V>> (U3 > 

For instance, for 0, : 0,5 rad/sec , ?, = 12.7 cm/sec and R-, = R, , tne 

i j 6 6, max 

dynamic significance of R^r^ one °* the dynamic significance of 6j. 

The sum (0j 4- R^if j) car -.ilse be zero. Figure 5 shows R^ as a function of 6^ 
for r^ = lll.o, 81.3, 50.8 cm, respectively. As seen, R^ max is dependent 
of r^. 
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It is noted again that some of the upper part of = 81.3 and 50. 8 cm curves 
are unrealizable for the JPL RRP breadboard for the same reasons as explained 
for Fig. 4. The qualitative differences between R^ and R^ are clearly seen 
by comparing Figs. 5 and 4. 

R^ is shorn in Fig. 6 as a function of 0^ f° r r 3 = 111. 8 # 81. 3, 50. 8 cm. For 
the upper part of the r^ = 81. 3, 50. 8 cm curves in Fig. 6 the remarks are the 
same as for Fig. 4. R^ measures the relative importance of 0^ as seen at 
joint #2, while Rj measures the relative importance of 0^ as seen at joint #1. 
Therefore, it is worthy to note both the quantitative and qualitative differences 
between R^ and R^ by comparing Figs. 6 and 4. The significance of R^ is again 
best seen in the equation: 

D t 2 8 , + D 22<>2 = D 22 (R 3 S 1 + V 11 141 

For instance, for J 0 ^ J = and R3 max * the reaction torque felt at joint #2 

due to the acceleration at joint #1 is 11% of the inertial torque at joint #2, 
which is substantially less than the 50% generated by the acceleration at 
joint #2 and felt at joint #1. For 0^ = [60,90] deg, however, and R^ 
become nearly equal. It should be noted that the dynamic significance of Rj 
and Rj in the respective total torque equations is widely different since no 
gravity torque acts at joint #1, while at joint #2 the gravity torque has a 
dominant effect. In many instances the gravity torque felt at joint #2 is 
several orders of magnitude greater than any acceleration torque felt at 
joint #2. Therefore, to evaluate the relative dynamic significance of the 
different acceleration torques with full meaning, the total torque equations 
should be considered. 

The ratio R^ has dimension "cm" since it is related to the sum of the two 
torques 

D 13 ®1 + D 33 *3 = D 33 (R 4® 1 + V (115) 
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The variation of is depicted on F : 7. is independent of r^, and varies 

as a sine wave scaled to a maximum amplitude of 16. 19 cm. It is seen 

2 2 

that for r, = 12. 8 cm/sec , 0. = 0. 5 rad/sec and R. = R. the dynamic 

3 1 4 4, max ’ 

significance of R^ 0. is about two-thirds of the dynamic significance of r^. 
This effect should be compared to the inverse effect expressed by R^r^ 
versus 0j in Eq. (113). See also example following Eq. (113). It is noted 
that the gravity force has a dominant effect at joint #3 as a function of 0^. 
Thus, the full significance of R^ cannot be evaluated without considering the 
total force equation for joint #3. In fact, it can be expected that the gravity 
force felt at joint #3 will overshadow any acceleration force component by 
several orders of magnitude in most of the time. 

Figures 4 through 7 can be combined into an integrated dynamic scheme for 
the torque /force equations in a straightforward manner according to the 
following equations, which are equivalent to Eqs. (101 through (103): 


sjc •• 

D ll< e l 

+ R^ + R 2 r 3 ) + ... 

.. = Tj 

(116) 

D 22<®2 

+ RjOj) + 

• • - T 

L z 

(117) 

D 33 (r 3 

+ *4*l) + 

rO 

fa 

1! 

• 

• 

(118) 


In these equations, Rj, R 2> R^, R^ should be considered with the proper 
i. signs (and not in absolute values!) according to the definitions given by 
Eqs, (104) through (107). The combined effect of the summation in the 
parentheses in Eqs. (116) through (118) can be zero as well as greater or less 
than any of the components in the parentheses. 

In summary, it is noted that all four ratios (Rj, R 2 , R^, R^) attain maximum 

value at 0, = 0 or 90 deg. Further, R, and R, require that, in addi- 

c i , max j , max 

tion to 02= 0 deg, we also have rj * mt x = III. 8 cm simultaneously. Both con- 
ditions are quite extreme from the view point of normal tasks expected forthe JPL 
RRP manipulator. When juch conditions may occur, two other things will also 
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happen simultaneously: (a) the related acceleration values are (or can be 

made) sufficiently low; or (b) the effect of the acceleration- related reaction 
torques /forces is significantly overshadowed by other dynamic effects (gravity 
torque or force). Hence, it is expected that acceleration- related reaction 
torques or forces will be quite insignificant under normal operating conditions. 

D. Simplification of Torque /Force Equations 

One of the main advantages gained by the development of the explicit state 
equations for the dynamics of the JPL RRP manipulator is that the relative 
significance of the different torques /forces as well as the relative importance 
of the different state components contributing to a torque or force term can be 
explicitly evaluated for varying tasks and operating conditions. In this memo, 
explicit state equations have been presented for total link inertias and gravity 
loads for all six link-joint pairs of the JPL RRP manipulator. Thus, we can 
evaluate the relative significance of the different state components contributing 
to the inertial and gravity terms at the joints, as well as assess the relative 
importance of the inertial and gravity loads acting at the joints as a function 
of the state of the manipulator. A full evaluation of all dynamic terms will be 
provided in a subsequent memo after the development of the state equations 
for the acceleration- and velocitv- related reaction torques /forces. 

1. Inertial Terms 

The state equations derived for the D.. dynamic coefficients in Section VI.B 
are transformation equations which transform the moments of inertia of the 
links ahead of link "i" (i + 1, i + 2, • • • , n), computed in the respective link 
coordinates, to the rotation axis of joint "i. " Examining the different com- 
ponents which contribute to variations in total inertias as a function of the joint 
position vector, it is seen that some components are insignificant and can be 
neglected without introducing sensible errors. In the subsequent simplifica- 
tions, the state equations for Du should be viewed together with the exact numer- 
ical data presented in Section VII. B where the maximum and minimum values of 
total inertias as seen at the six joint axes have been determined. 
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a. 


Joint #1: Simplified State Equation for D 


: ; IV 

Since 11 an< ^ m 2^233 are near ^V ec l ua ^ magnitude, we have 


m 2 k Zll s20 2 + m 2 k 233 c20 2 = + c20 2 ) = a 


where n a n is the mean value of the two moments of inertia. It is a constant, 
and can be added to the constant components of 

The following moments of inertia can be set eq ual to zero due to their jmall 
value relative to other components in the state equation for D, 


m 3 k 333 

m 4 k 411 

m 4 k 422 

m 4 k 433 

m 5 k 511 

m 5 k 522 

m 5 k 533 

m 6 k 611 

m 6 k 622 

m 6 k 633 
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A 11 these simplifications reduce the state equation for D to less than one-third 

of its complete (and extremely complex and lengthy) form given by Eq. (58). 

The error introduced by these simplifications will be very small: less than 

0. 5% for D. , and less than 2% for D, , 

1 1 , ma x 1 1 , max 

Introducing the simplifications defined above, and performing the possible 

algebraic reductions of the remaining terms in Eq. (58), the state equation of 

Dj j takes the following simplified form: 


D n = b 


(b hr +br^)s^0 


2 \ 2 . 


4 r 3 ~3 5 + b 6 s(2G 2 )s6 4 s © 5 + b ? s(20 2 )c0 4 + bgS(20 4 )sG 5 J 


+ bg (" c 0 4 s 2 0g + s 2 0 2 c 2 0g + c 2 0 2 s 2 0 4 s 2 0,- + 3(20 2 )s0 4 s0^c0^ 


* b 10 c V e 5 +b ll 89 4 + b 12 


(119) 


where b^ b^ 2 are constants given by 


bj = Constant components of (see page 48) 
+ j ( m 2^21 1 + m 2 k 233 ) 


1. 319 kg* 

0. 104 kg* m 2 


Total: 1.423 kg* m 2 



No load in 
the hand 

With load in the hand 
(Load as specified) 

b 2 * m 3 k 322 

2.51 

2.51 

kg* m 2 

b 3 = 2 (m 3 7 3 ‘ m 4^4 ) 

-5.49 

-5.49 

kg*m 

b 4 = m 3 + m 4 + 3 + 

6. 48 

8.27 

kg 
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No load in 
the hand 

With load 
(Load as 

In the hand 
specified) 

b 5 = 2m 5 7 5 + 2m 6 (7 6 + r fe ) 

0. 232 

0. 396 

kg. m 

b 6 ' m 6 (r 6 + V 

0. 08 

0. 523 

kg. m 

b 7 = m 4% 

-0. 006 

-0. 006 

kg. m 

b 8 = m 5 7 5 

0.036 

0. 036 

kg* m 

b 9 = m 6 r 6 (r 6 + 2 V 

0. 008 

0. 118 

. 2 
kg. m 

b 10 = 2r 2 (m 5 7 5 + m 6 ¥ 6 + m 6V 

0. 038 

0. 181 

. 2 
kg* m 

b ll = 2m 4 Z 4 r 2 

-0. 002 

-0. 002 

, 2 
kg- m 

b i? = m 6 r 2 

0. 013 

0.059 

. 2 
kg. m 


In view of the numerical value of the constants b^, • ..» b i 2 > Eq. (119) can 
be further simplified without introducing sensible errors. The most significant 
part of Eq. (119) is the first line which contains bj.b^bj, and b 4> With no 
load in the hand, these components yield for r^ = 111.8 cm and = 0 and 90 deg: 


D ll,min 
D 11 , max 


1. 423 kg* m 2 
5, 89 kg.m 2 


Comparing these values to those given by Eqs. (71) and (69), it is seen that 
the error is 4%. With load in the hand, however, the same components yield 


11, max 


= 8. 15 kg.m 


which has an error about 15% when compared to the corresponding exact value 
given by Eq. (70). This error can be reduced to 10% if the bj term is retained 
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in Eq. (119). Retaining the b term in Eq. (119) will also reduce the error in 

-> 

D. , with no load in the hand from 4% to 1%. The b c term will also account 

1 1 , max 5 

for the major part of the variations in due to changes in 6^. Hence, a very 
simple and sensible state function which approximates the value of with 
good accuracy is the following expression: 



( 120 ) 


where the values of parameters b^ and b^ also depend on the load held in the 
hand according to the simple formulas specified above for b^ and b^. Compar- 
ing Eq. (120) to Eq. (58), it is easily seen that the computational complexity of 
Djj will be reduced nearly by 98% -vhen Eq. (58) is replaced by Eq. (120). The 
content and strength of Eq. (120) becomes apparent after physical reasoning. 


b. Joint No. 2: Simplified State Equation for D22* 

In the state function for D ^ given by Eq. (60) the fol- 
lowing moments of inertia can be neglected due to their small relative value: 


i 2 

m 4 k 411 


m 4 k 433 


m 5 k 511 


m 5 k 522 


m 5 k 533 


m 6 k 6ll 

m 6 k 622 


m 6 k t) 3 
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Introducing these simplifications, Eq. (60) can be written in the following 
reduced form: 


°22 = b 13 + b 4 r 3 + (b 3 +b 5 c0 5 )r 3 


+ b 9 (« 2 e 4 ^ e 5 + r 2 e 5 ) 


( 121 ) 


where 


= constant components of (see page 62) 

= 4.72 kg.m 2 

b^. b^, b^.bg are constants, identical to those defined and computed 
for Djj previously. (See pages 84 and 85. ) 

Equation (121) yields the following extremum values for D^: 


2 

D,_ (no load in the hand) = 7.09 kg.m 

22, max 

D,_ (with load in the hand) = 9.64 kg. m^ 

22, max ® 

2 

D,» (no load in the hand) ',69 kg« m 

cc % mm 0 


Comparing these values tj the corresponding .\*ct v s given by Eqs. (74), 
(75), (76), it is seen that the error introduced tr’ ' nplificaiions is between 

2% and 6%. Equation (121) can be further simpifiet omitting the b^ term, 
and the total maximum error introduced into D ^ .ill still be less than 8%. 
Hence, a very simple and sensible state function which approximates the value 
of D 22 with good accuracy is: 



( 122 ) 


where the values of parameters b^ and bg also depend on the load he. *n the 
hand according to the simple formulas defined on pages 84 and 85 for Dij. It in 
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worthy to note that the b^.b^.b^ terms in Eqs. (122) and (120) are identical, 
except that they are not multiplied by s 2 ®^ * n Eq. (122). Comparing Eq. (122) 
to Eq. (60), it is seen that the computational complexity of is reduced 
nearly by 90% when Eq. (60) is replaced by Eq. (122). The content and strength 
of Eq. (122) is apparent by physical reasoning. 

c. The Wrist Joints . 

As discussed in Subsection VII. B-4, the state function 

of D . . given by Eq. (64) is being reduced without simplifications to the follow- 

’’ 2 2 
ing form due to the equality m^k^ ^ = m ^^22 : 


44 


= b 


14 


tb 15 s % 




(123) 


where 

b^ = constant components of (see page 57) 


= 0. 107 kg.m 


2 


and the other constants are given by: 



No load in 

With load in the hand 


the hand 

(Load specified) 

b 15 * m 5 k 511 + m 6 k 6ll + b 9 

0. 015 

0.127 kg-m 2 

b l6 = m 5 k 533 + m 6 k 633 

0. 001 

0.002 kg.m 2 


Neglecting the bj^ term in Eq. (123) will introduce only l% — 6 % error. Hence, 
we have the following simple state function which approximates the value of 
^44 ^ 8°°d accuracy: 



(124) 


where the value of parameter b J5 ah < depends on the load in the hand accord* 
ing to the simple expression specified above. A'\' n, the content of Eq. (124) 
is apparent by simple physical reasoning. 
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As shown in Subsection VII. B-5, 


the value of and 


is constant: 


D r - 

= b, - 

+ V> _ 

55 

17 

18 


°66 

O' 

& 

II 

+ b 20 


(125) 

( 126 ) 


The parameters in Eqs. (125) and (126) are separated into two parts: and 

bj^ are true constants, while the value of b^g and b£g depends on the load held 
in the hand ccording to the following expressions: 



No load in 

With load in the hand 


the hand 

(Load specified) 

b 18 = m 6 k Ml +b 9 

0.013 

0. 125 kg* m 2 

b 20 = m 6 o33 

0. 0004 

0. 002 kg* m 2 


While the true constants are: 

b 1? = 0.099 kg- m 2 
bjg = 0.02 kg* m 2 

No specific simplifications are needed for given by Eq. (62) since 
Dgg is a constant; its value can only be changed by the mass of the load held 
in the hand. 

The functional form of the simplified state equations for the D^, D^, 
^44 coefficients is noteworthy: 

D ll = f ( e 2' r 3 ,e 5 ,b r b 2 ,b 3 ,b 4 ,b 5) 

D 22 * £ ( r 3 ,e 5» b 3» b 4 ,b 5 ,b 13) 

°44 * '(V b I4» b ») 
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where superscript "L" indicates that the respective "b" parameters also 
depend on the load held in the hand. 

2. Gravity Terms 

The complete state equations for the gravity terms developed 
and presented in Section VI. A are not too complex functions. The functions 
for D 2 and given by Eqs. (48) and (52) can be slightly simplified if needed 
for a price of small errors. 

The state function for can be organized in the following form: 

D 2 = g(dj + d 2 r 3 )s0 2 + gd 3 (s6 2 c0 5 + C0 2 s0 4 s0 5 ) 


+ gd 4 c 0 2 c0 4 


(127) 


2 

where g = 9. 81 m/sec (acceleration of gravity), and the constant parameters 
dj d 4 are given by 



No load in 
the hand 

With load in the hand 
(Load specified) 

d l = m 2 z 2 + m 3 7 3 " m 4 y 4 

-2.788 

-2. 788 

kg* m 

d 2 = m 3 + m 4 + m 5 + 

6.47 kg 

8.28 

kg 

d 3 = m 5 I 5 + m 6 (i' 6 + r 6 > 

0.116 

0. 566 

kg* m 

d 4 * m 4 I 4 

-0.006 

-0.006 

kg* m 


As seen, the d 2 and d^ parameters depend on the load held in the hand. 

Equation (127) is exact. It is seen, however, that the contribution of the 
d 4 term to the value of D 2 is insignificant, less than 1%. Thus, we can use the 
following simplified equation which reproduces the value of with very good 
accuracy: 


D 2 * g(dj + d 2 r 3 )s0 2 + gd 3 (s0 2 c©g + c0 2 s0 4 s0g) 


(128) 
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It is noted that the potential importance of the term increases as r^ 
and/or 6^ decreases. 

The exact state function for can be expressed as 

d 4 = g d 3 s0 2 c0 4 s0 5 - gd 4 s6 2 s0 4 (129) 


where the parameters d^ and d 4 are identical to those defined and computed for 
D 2 above. The relative significance of the d 4 term in Eq. (129) can be expected 
as small in most of the time. Hence, we can use the following reduced state 
function as a good approximation for D 4 : 


D = gd,s0_c0.s0_ 
4 6 3 2 4 5 


(130) 


However, the form of Eq. (129) is simple. Therefore, not much is gained by 
omitting the d 4 term from Eq. (129) if the maximum 0. 056 N*m value of the d 4 
term (as referred to the output) seems important. 

It is noted finally that the state functions for and given by Eqs. (50) 
and (54), respectively, can be written as: 


D 3 = "S d 2 c0 2 


(131) 


D 5 = 8 d 3 ( 8 ®2 8 ®4 c ®5 ■» ce 2 s0 5 ) 


(132) 


where the parameters d 2 and d^ are identical to those defined and computed for D 2 
previously. 

The simplified state equations developed for the inertial and gravity terms 
of the JPL RRP manipulator together with the related parameters are summar- 
ized in Tables 3 and 4. 

E. Relative Importance of Gravity Terms Versus Inertial Terms 

The simplified state equations for the gravity and inertial terms allow an 
easy functional evaluation of the relative importance of gravity versus inertial 
terms in the torque/force equations. We form the following four ratios: 


K 


D 2 
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Table 3. Simplified State Equations for Inertia and Gravity 
Loads at the Six Joints 


Inertia Terms: 



L: depends on the load in the hand 
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Table 4. Parameters in the Simplified State Equations for 
Inertia and Gravity Loads 

b l 


1. 423 kg- m 2 
(201. 5 oz-in-sec 2 ) 

b 2 


2.51 kg • m 2 
(355. 5 oz-in-sec 2 ) 

b 3 


-5. 49 kg* m 
(-19. 75 oz-sec 2 ) 

h L 

b 4 

= rrij + m 4 + 

6. 48 kg* 

(0.592 (oz-sec 2 )/in) 

h L 

b 5 

= Zitijlj + Zm 6 (z 6 + r & ) 

0.232 kg-m* 

(0. 834 oz-sec 2 ) 

b 13 


4. 72 kg. 

(668 oz-in-sec 2 ) 

b 14 


0. 107 kg. m2 
(15. 17 oz-in-sec2) 

b L 

b 15 

= m s k Sll + m 6 k 611 +m 6 r 6 (r 6 +2 V 

0. 015 kg. m 2 * 

(2. 19 oz-in-sec2) 

b 17 


0. 099 kg* m 2 
(14.01 oz-in-sec 2 ) 

,L 

b 18 

= m 6 k 2 u +m 6 r 6 (r 6 + 27 6 ) 

0. 013 kg. m^* 

(1. 81 oz-in-sec 2 ) 

b 19 


0. 02 kg* m 2 

(2. 81 oz-in-sec 2 ) 

* 

= m 6 k 633 

0. 0004 kg.m^* 

(0. 05 oz-in-sec 2 ) 



-2. 788 kg* m 
(-10. 03 oz-sec 2 ) 

d L 

d 2 

= bj'anddj' = 0.05bj 



Lit depends on the load in the hand 

*t quoted number is referred to "no load" in the hand 
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( 134 ) 


k - P 3 _ Eq. (131) 
2 D 33 “ Eq. (62) 


D 4 Eq. (130) 
3 ' D 44 - Eq. (124) 


(135) 


_ _?5_ _ Eq. (132) 
4 D 55 " Eq. (125) 


(136) 


For 0 4 = 6^ = 0 deg, we have the following expression for according 
to the definition given by Eq. (133): 


K ! * 


g(d J +d 3 +d 2 r 3 ) 


b 13 + ( b 3 +b 5 )r 3 + b 4 r 3 


2 s(l 2 


1 

rad/ sec' 


(137) 


As seen from Eq. (137), the relative importance of gravity torque versus 

inertia torque at joint No. 2 varies essentially as a tiine wave of 0^ with an 

amplitude dependent on r 3# The absolute value of given by Eq. (137) is 

shown in Fig. 8 for three r^ values. The "b" and "d" parameters which appear 

in Eq. (137) and depend on the load in che hand are taken for the specified 

load. The function K. is normalized to 1 rad/sec^ angular acceleration at 

1 2 

joint No. 2. For instance, if = 0. 5 rad/ sec , the gravity torque at joint 
No. 2 for 0£ = 60 deg and r^ = 96. 5 cm is 14 times the value of the inertia 
torque. Or, for the same conditions, the gravity torque is only 3. 5 times the 
value of the inertia torque if 0^ = 2 rad/ sec . 

The ratio defined by Eq. (134) simply gives (without any condition on 
any state variable): 



Thus, the relative importance of gravity force versus inertia force at 
joint No. 3 varies exactly as the cosine of 6^ with a maximum 
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Figure 8. Relative Ir >rtanco of Gravity versus Inertia 

To ,ue at Joint #2 
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amplitude = g = acceleration of gravity. The absolute value of is shown 

in Fig. 9. It is noted that K_ is independent if any inertial or geometric 

^ 2 

parameter. The ratio on Fig. 9 is normalized to 1 cm/sec linear acceler- 
ation at joint No. 3. 

For 0^ = 0 deg, the ratio defined by Eq. (135) gives the following 
expression: 


K 


3 


gd 3 * e 

— - T ~ 8 e 2 

b 14 + b 15 8 ®5 



(139) 


Thus, the relative value of gravity torque versus inertia torque acting at joint 

No. 4 varies essentially as a sine wave of 0^ with an amplitude dependent on 0^. 

The absolute value of given by Eq. (139) is shown in Fig. 10 for two 0g 

values. Again, the "b" and "d" parameters, which appear in Eq. (139) and 

depend on the load in the hand, are taken for the specified load. The ratio K, 

2 

is normalized to 1 rad/sec angular acceleration at joint No. 4. It is interest- 
ing to note that the relative importance of gravity torque versus inertia torque 
can be more predominant at joint No. 4 than at joint No. 2 as seen by comparing 
Figs. 8 and 10. 

For 0g = 90 deg, the ratio defined by Eq, (136) gives the following 
expression: 



Thus, the relative value of gravity torque versus inertia torque varies exactly 
as the cosine of 0^ for 0g = 90 deg. But, as seen from Eq. (132), will vary 
as the sine of 0 ^ if 0g * 0 deg and 0^ « 90 deg. Or, if s 0 deg, then 
varies as the sine of 8g. However, the maximum amplitude of any wave vari- 
ation in K. is fixed, independent of any state variable. Figure 11 shows the 

* 2 
absolute value of as given by Eq. (140), normalised to 1 rad/sec angular 

acceleration at joint No. 5. As seen from Figs. 8 and 11, the relative impor- 
tance of gravity torque versus inertia torque at joints No. 2 and No. 5 can be 
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Figure 11. Relative Importance of Gravity vereue Inertia 

Torque at Joint #5 
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+ 

nearly equal.' Again, the values of parameters d^ and b^g ir (140) are 
taken for the specified load held in the hand. 

As a main conclusion, it is seen that the gravity terms at joints No. 2 , 

3, 4, and 5 have a relatively high significance versus the corresponding inertia 
terms. However, the overall significance of the gravity terms in the torque/ 
force equations can only be evaluated when all relevant reaction torques/forces 
are also considered in the equations. 

The four ratios given by Eqs. (137) through (140) and displayed in Figs. (8) 
through (11) are linear functions of the field of gravity "g." For "g" values 
smaller than the "g" on Earth (for instance on the Moon or Mars), the relative 
importance of gravity terms versus inertia terms at joint No. 1 s 2, 3, 4, and 
5 of the JPL RRP manipulator would correspondingly decrease. 


^ Since Kj, K>, ICj, K4 are defined in terms of the corresponding simplified state 
functions which carry some error, the ratios displayed In Figs. 8 through 11 
will also carry some error. Xn the average, however, the error in the ratios 
can be expected less than 8 — 10%. 
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APPENDIX A 


COMPLETE SET OF PARTIAL DERIVATIVE MATRICES U:s 
IN FUNCTIONALLY EXPLICIT FORM J 

FOR THE JPL RRP MANIPULATOR 


The partial derivative matrix functions U^ are essential "building blocks" in the 
general algorithm applied in this memo for the dynamic model of a manipulator. 
To deiive the explicit functional relations for the D., D.., and D.. coefficients 
in the dynamic equations for the JPL RRP manipulator, the Uj. matrices must 
first be determined in a functionally explicit form for this particular 
manipulator. 

The general function definition for the U^. rr. 'ices is given in Section III in the 
main text. For easy reference, the functional meaning of the tvo running matrix 
indices in the Ujj notation is repeated here: the first index (j) always refers to 
the highest index number in the concatenated link transformation matrix, while 
the secon d index (i) always refers to the index number of the joint variable with 
respect to which the partial derivative is taken in the concatenated link trans- 
formation matrix. Consequently, U.. i 0 only for i s j; otherwise for i > j 

U ji S °* 

As seen from the definition, the U„ matrices are functions of the manipulator 
joint variables and link displacement constants. In general, for a system of n 
joint variables a particular U.j matrix becomes a function of all joint variables 
and link displacement constants starting from index 1 and going up to (and 
including) index j, but will be independent of the joint variables and link dis- 
placement constants which have index number greater than j. It is noted that 
the dimensionality of the ILj matrices is 4 by 4. 

In this Appendix all U.^ matrix functions which are pertinent to the JPL RRP 
manipulator are compiled in an expanded and functionally explicit form. Deal- 
ing with a six degrees-of-freedom manipulator (i, j = 1, .... 6), and keeping in 
mind that Ujj i 0 only for i S j, we will have 21 matrix functions different 

from sero. The individual functional definitions for all 21 U.. i 0 matrices are 

J 1 * 

listed in Table A. 1. The six individual link transformation matrices Tj_j 

(i s 1, . . . , 6), upon which the explicit expansion of the 21 i 0 matrices of the 

JPL RRP manipulator is based, have been given previously in Table 2 of Ref. 1. 
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The subsequent 21 functionally explicit expressions for the Uj. matrices for this 
mrnipulator are not available elsewhere in the literature. 

The parameter and variable definitions and notations used in this Appendix are 
identical to those specified in Tables 1 and 2 of Ref, 1. In particular, it is 
noted that we use the following short notations 

s. = sin 0. 
i i 

c, = cos 0. 

i l 


in the subsequent expressions. 





- 8 1 

0 

- c ^ 0 



C 1 

0 

- 8j 0 



0 

0 

0 0 



0 

0 

1 

O 

o 



“ s l c 2 

- C 1 

8 1 8 2 

1 

U 

fM 

U 

i 


C 1 C 2 

“l 

C 1 S 2 

' r 2 8 l 


0 

0 

0 

0 


0 

0 

0 

0 


C 1 

- 8 1 C 2 

’ b 1*2 

- (r 3V 

2 + r 2 c P 

§ 1 

c l c 2 

c i*2 

(r 3 c l s 

2 ’ r 2*i) 

0 

0 

0 


0 

0 

0 

0 


0 J 
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(A. 1) 


(A. 2) 


(A. 3) 


A-3 


m 




< c l c 4 - 8 1 C 2 8 4> 

S 1 S 2 

-( c l s 4 + S 1 C 2 C 4 ) 

-( r 3 S l S 2 + 

r 2 c l> 

' s l c 4 + c l c 2 8 4> 

- c 1 8 2 ' 

• (s l s 4 " C 1 C 2 C 4 ) 

(r 3 C l S 2 ‘ 

r 2 s l> 

0 

0 

0 

0 

0 

0 

0 

0 

( c 1 C 4 C 5 

- (c l s 4 

< C 1 C 4 S 5 

-<Vl s 2‘ 


S 1 C 2 S 4 C 5 

+ V2 C 4> 

- s 1 c 2 s 4 s 5 

+ r 2 c,) 


+ 8l 8 2 s 5 ) 


- S 1 S 2 C 5 ) 



( S 1 C 4 C 5 

- (8 l 8 4 

( S 1 C 4 S 5 

( r 3 c l s 2 


+ Cl c 2 s 4 c 5 

- c lC2 c 4 ) 

+ Cl C 2 8 4 8 5 

• r 2 s l> 


- c 1 8 2 8 5> 


+ Cl S 2 C 5 ) 



0 

0 

0 

0 


0 

0 

0 

0 



I 
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(c l c 4 c 5 c 6 

- Sl C 2 8 4 C 5 C 6 

+ S 1 S 2 S 5 C 6 
" C 1 S 4 S 6 

- S 1 C 2 C 4 S 6 ) 


( S 1 C 4 C 5 C 6 

+ C 1 C 2 S 4 C 5 C 6 

- c 1 8 2 8 5 c 6 

“ 8 1 8 4 8 6 
+ c lC 2 c 4 s 6 ) 


( ‘ C 1 C 4 C 5 S 6 
+ 8 lC2 8 4 c 5 8 6 

' S 1 S 2 S 5 S 6 
" C 1 S 4 C 6 
• 8 1 c 2 c 4 c 6 ) 


( ' 8 1 c 4 c 5 8 6 

' C 1 C 2 8 4 C 5 8 6 

+ c 1 8 2 8 5 8 6 

‘ S 1 S 4 C 6 
+ Cl c 2 c 4 c 6 ) 


(c l c 4 S 5 

- s 1 c 2 s 4 s 5 

- S 1 S 2 C 5> 


( 8 1 c 4 8 5 
+ C 1 C 2 S 4 S 5 
+ C 1 S 2 C 5^ 


i r 6 {c l c 4 S 5 
' 8 1 C 2 8 4 8 5 
- 8 1 8 2 c 5 ) 

• (r 3 S l S 2 

+ r 2 c lH 


{ r 6 (8 l C 4 8 5 

+ c 1 8 2 c 5 
+ (r 3Cl s 2 


- r 0 s 


1>» 


(A. 6) 


U 


22 


c 1 8 2 0 c l c 2 0 


8 1 8 2 0 8 1 C 2 0 


c 2 0 


*2 0 


(A. 7) 


U 


32 


'Vz c l c 2 r 3 C l C 2 


" 8 1*2 *1 c 2 r 3*l C 2 




•I, 


” r 3*2 


0 0 0 0 
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: 1 8 2 8 4 

" c l c 2 ' c 

1 S 2 C 4 r 3 C l C 2 

5 1 8 2 8 4 

" s l c 2 ' 8 

1 S 2 C 4 r 3 S l C 2 

c 2 8 4 

8 2 

C 2 C 4 _r 3 S 2 

0 

0 

0 0 

c 1 8 2 8 4 C 5 

- c 1 8 2 C 4 

( " c 1 8 2 8 4 8 5 

+ c 1 c 2 8 5^ 


+ Cl c 2 c 5 ) 

8 1 8 2 8 4 c 5 

” 8 1 8 2 c 4 

(” 8 1 8 2 8 4 s 5 

+ 8 ^ 285 ) 


+ 8 l c 2 c 5 ) 

‘" C 2 8 4 C 5 

” C 2 C 4 

-( c 2 8 4 8 5 

+ s 2 s 5 ) 


+ s 2 c 5 ) 


r-c.c, 


~ r 3 S 2 


(A. 9) 


(A. 10) 
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■ (c 1 8 2 s 4 c 5 c 6 
+ c i c 2 s 5 c 6 
+ c 1 8 2 c 4 s 6' 


■ (s 1 8 2*4 c 5 c 6 
+ 8 1 C Z 8 5 C 6 
+ »1»2 c 4 8 6 ) 


(' c 2 8 4 c 5 c 6 
+ 8 2 8 5 c 6 
- c 2 c 4 8 6> 


(c 1 8 2 8 4 c 5 8 6 ( ‘ c 1 8 2 8 4 8 5 


+ c 1 c 2 8 5 8 6 
- c 1 8 2 c 4 c 6' 


+ Cl c 2 c 5 ) 


( 8 1 8 2 8 4 c 5 8 6 <- 8 1 s 2 8 4 8 5 l r 6 (_ 8 1 8 2 8 4 s 5 


+ 8 1 c 2 8 5 8 6 
- 8 1 8 2 c 4 c 6 ) 


(c 2 8 4 c 5 8 6 
‘ 8 2 8 5 8 6 
" C 2 C 4 C 6* 


+ 8 l c 2 c 5 ) 


• (c 2 8 4 8 5 

+ S 2 C 5 ) 


1 r 6 ( _C 1 S 2 S 4 S 5 
+ Cl c 2 c 5 ) 

+ r 3 c lC2 } 


+ S 1 C 2 C 5 ) 
+ r 3 s lC2 } 


-I r 6 (c 2 8 4 8 5 
+ s 2 c 5 ) 

+ r 3 s 2 i 


(A. 11) 


U 


33 


0 0 0 C 1 B Z 


0 0 


8 1 8 2 


(A. 12) 


U 


43 


0 0 0 Cj» 2 


8 1 *2 


(A. 13) 
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0 0 0 0^2 


S 1 S 2 


U 


53 


(A. 14) 


0 0 0 c i s 2 


®1 S 2 


U 


63 


(A. 15) 


U 


44 


(-8i 8 4 + c i c 2 c 4 ) 0 -(s,c 4 + c x c 2 s A ) 0 


{c 1 8 4 + 8 1 c 2 c 4 ) 


" 8 2 C 4 


14 x ''r2 D 4 / 


(c l c 4 ‘ 8 1 c 2 8 4 ) 0 


8 2 8 4 


(A. 16) 


U 


54 


<'V4 C 5 
+ Cl c 2 c 4 c 5 ) 


( c 1 *4 C 5 


" 8 2 c 4 C 5 


-(s,c 


l w 4 


< c l c 4 
- *i c 2*4> 


*2*4 


<-*l*4*5 


+ Cl r 2 . 4 ) t CjC^.j) 


(<=1*4*5 

+ *J C 2 C 4*5* 


'*2 C 4*5 


(A. 17) 


A-8 
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'(•'l*4 c 5 c 6 


(s l s 4 c 5 s 6 


(-*1*4*5 


r 6 (-Sl » 4 » 5 




1 2 4 5 6 


+ c l c 2 c 4 8 5 ) 


+ C 1 C 2 C 4 S 5 ) 


' S 1 C 4 S 6 
■ c 1 c 2*4 b 6 ) 


' S 1 C 4 C 6 
" C 1 C 2 S 4 C 6 ) 


U 


64 


(C 1 S 4 C 5 C 6 
+ S 1 C 2 C 4 C 5 C 6 
+ C 1 C 4 S 6 
" 8 l c 2 S 4 8 6 ) 


( - C l 8 4 C 5 8 6 
- b i c 2 c 4 c 5 8 6 
+ C 1 C 4 C 6 
- S 1 C 2 S 4 C 6 ) 


( C 1 S 4 S 5 
+ S 1 C 2 C 4 S 5 ) 


r 6 (c l S 4 S 5 
+ 8 j c 2 c 4 s 5^ 


(A. 18) 


( ' S 2 C 4 C 5 C 6 
+ s 2 8 4 8 6 ) 


(s 2 C 4 C 5 S 6 
+ 8 2 s 4 c 6 ) 


' S 2 C 4 S 5 


-T, S_C . 8 _ 

6 2 4 o 


U 


55 


■ (8 1 C 4 8 5 
+ c 1 c 2 8 4 8 5 

+ C, 8 2 C 5 ) 


( c 1 c 4 8 5 
- 8 1 c 2 8 4 8 5 
" *1 8 2 c 5 ^ 


< 8 2 V5 


C 2 C 5> 


( 8 1 C 4 C 5 
+ c 1 c 2 8 4 c 5 


” c l®2 


8 5> 


<* C 1 C 4 C 5 
r8 l c 2 9 4 c 
- 8 1 8 2 8 5> 


-( 8 2 - 4 c 5 

+ c 2 3 5 ) 


(A. 19) 
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u 


65 


-( 8 1 c 4 8 5 c 6 
+ c 1 c 2 8 4 8 5 c 6 
+ c 1 8 2 c 5 c 6 ) 

( c 1 c 4 8 5 c 6 
- 9 l c 2 8 4 8 5 c 6 
- 8 1 8 2 c 5 c 6 ) 

( 8 2 8 4 8 5 C 6 
‘ C 2 C 5 C 6 ) 


( 8 1 c 4 8 5 8 6 
+ c 1 c 2 s 4 8 5 8 6 

+ Ci 8 2 c 5 8 6 ) 


(- c 1 c 4 8 5 8 6 

+ 8 1 c 2 8 4 8 5 8 6 
+ *1*2 C 5®6 ) 

*- 8 2 *4*5*6 
2 C 5 8 6 } 


( S 1 C 4 C 5 
+ C 1 C 2*4 C 5 

- CjS^) 


(” C 1 C 4 C 5 
+ * 1 c 2 b 4 c 5 

- s 1 8 2 8 5 ) 


'< 8 2*4 C 5 
+ c 2*5> 


r 6 (s l c 4 c 5 
+ C 1 C 2 S 4 C 5 
- c 1 8 2 8 5 ) 


r 6 ( ' c l c 4 c 5 
+ 8 1 c 2« 4 c 5 
- 8 1 s 2 8 5 ) 


- r 6 ( 8 2 B 4 C 5 

+ c 2 8 5 ) 


(A. 20) 


U 


66 


(* 8 1 C 4 C 5 8 6 
" C 1 C 2*4 C 5*6 
+ C 1 *2*5*6 
” *1 8 4 c 6 
+ C 1 C 2 C 4 C 6 ) 

< C 1 C 4 C 5*6 
- •i c 2*4 c 5 , 6 
+ b i*2*5*6 
+ C 1*4 C 6 
+ *1 C 2 C 4 C 6 ) 

(*2*4 c 5*6 
+ c 2*5*6 
* *2 C 4 C 6* 


(* 8 1 c 4 c 5 c 6 
" c 1 c 2 8 4 c 5 c 6 
+ c 1 8 2 8 5 c 6 
+ *1 *4*6 
- C 1 C 2 C 4*6 ) 

< C 1 C 4 C 5 C 6 
‘ *1 C 2*4 C 5 C 6 
+ *1*2*5 C 6 
“ c 1*4*6 
' •l c 2 c 4*6 ) 

( *2*4 C 5 C 6 
+ C 2*5 C 6 

+ • 2 c 4 » 6 ) 


(A. 21) 
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APPENDIX B 


LINK MASS CENTER VECTORS AND PSEUDO INERTIA MATRICES FOR 

THE JPL RRP MANIPULATOR 

Using the notations introduced in Section HI in the main text, and applying the 
parameter values determined for the JPL RRP manipulator elsewhere (see 
footnote on p. 47), the six link mass center vectors and the six pseudo inertia 
matrices are compiled in this appendix. The essential point in the subsequent 
listing is to distinguish betw? -jn zero and non-zero parameter values. The 
actual numerical values for the non-zero inertial parameters are supplied at 
the end of this Appendix. 

Mass Center Vectors 



' 0 ' 


' 0 ' 


*1 



*1 ■ 


V 



•\ 


‘4 


1 


_ 1 


•0 ■ 


* 0 ‘ 


*2 


0 



= 


2 

*2 

5 

*5 


1 

m m 


1 

• « 


"0 ‘ 


' 0 ' 


0 


0 

p _ 


? _ 


3 

T 3 

6 ’ 

*6 


1 

m m 


1 


As seen, for end we use sero since their numerical value is very small. 
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Pseudo Inertia Matrices 


2 2 2 2 2 2 

Note: k. , = k. , k.~~ = k. , k.- 0 = k. and the first index (i) refers to the 

ill ixx i22 xyy i33 izz 

index number of the link. 


J, 


II J +k 2 +k 2 

2\ *111*122*133) 


it 


k lll ' k 122 + k 133/ 


*1 


l/ k 2 +k 2 _ w 
2\*1 1 1 + *122 *133; 


) Z 1 


h 


^2 = m 2 


2(" k 211 +k 222 + k 233) 


2(^11 " k 222 + k 233) 


2( k 2il + k 222 -k 233) 


*2 
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0 


0 


0 


I /_ k 2 

2 \ K 61 1 


+ k 2 +k 2 
h k 622 + k 633 


) 


2( k 611 " k 622 + k 633) 


J 6 = m 6 


±( k 2 

2 \ 6 1 1 


+ k 2 -k 2 ) 

+ k 622 *633/ t 


Remarks on loads in the manipulator hand, and the inertial characteristics of 
link 1 6; 

It is noted that the mass center vector and "pseudo inertia matrix" as 
specified in this appendix are only related to the fixed, constant structure of 
link #6. (Link #6 includes also the hand.) If the manipulator hand keeps and 
moves a load, then the inertial properties of the load should be properly added 
to the inertial properties of link #6. That is, the value of the ve 'for and 
matrix should be modified according to the inertial properties of the load. 
Changes in torques (and force) due to a load kept and moved by the hand will be 
"felt" (and can also be computed) at the different joints through the appropriate 
modifications of the value of the f> ^ vector and matrix. 

Clearly, when handling irregular (and, by definition, "remote") objects with 
mass comparable to the mass of link #6, only compensating estimates can be 
made for changes in the inertial properties of link #6. Even when handling regu- 
lar objects, the changes in the inertial properties of link #6 can only be esti- 
mated, since it is not known ahead of time how the grasping operation will 
exactly succeed in emplacing the object relative to the hand coordinate frame, 
or which is the same, relative to the coordinate frame of link #6. 

The effect of handling loads (that is, the effect of modifications in the inertial 
properties of link #6) on some of the manipulator dynamic coefficients is shown 
in the subsequent appendix. 
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Numerical values of non- zero inertial components of the JPL RRP manipulator 


determined elsewhere (see footnote on p. 
follows : 


m l 


9.29 kg 

*1 

= 

1.75 cm 

*1 

= 

-1 1. 05 cm 

m l k lll 

= 

0. 276 kg. m 2 

m l k 122 


0.255 kg.m 2 

m l k 133 

= 

7 

0. 071 kg* nr. 

m 2 

= 

5. 505 kg 


T 

-10. 54 cm 

*2 

S 

-0. 79 cm 

,m 2*4ll 

= 

0. 108 kg* m 2 

"*2*222 

« 

0. 018 kg. m 2 

"*2*233 

S 

0. 1 kg* m 2 

m 3 

* 

4.25 kg 

h 

£ 

-64.47 cm 

m 3*311 

m 

2.51 k|>m 2 

m 3*322 

m 

2.51 kg*m 2 

m 3*333 

* 

2 

0.006 kg.m 
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47), and applied in tL:~ report are as 

= (0. 849 (oz-sec 2 )in' 

= (0. 69 in) 

= (-4. 35 ini 

2 

= (39. 1 oz-in-sec ) 

= (36. 15 oz-in-sec 2 ) 

= (10. 03 oz-in-sec 2 ) 

= (0.513 (oz-sec 2 )/in) 

= (-4. 15 ir.) 

= (-0.31 in) 

= (15. 28 oz-in-sec ) 

= (2. 49 oz-in-sec ) 

= (14. 13 oz-in-sec 2 ) 

= (0. 388 (oz-sec 2 )/in) 

* (-25. 38 in) 

2 

* (355. 5 oz-in-sec ) 

2 

* (355. 5 os-in- sec ) 

* (0. 854 os-in-sec 2 ) 
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m 4 


1. 08 kg 


(0.099 (oz-sec 2 )/in) 

^4 


0. 92 cm 

= 

(0. 364 in) 

*4 

= 

-0. 54 cm 


(-0. 212 in) 

ni 4 k 4H 

= 

0. 002 ke* m 2 

w 

- 

(0.253 oz-in-sec 2 ) 

m 4 k 422 

= 

0. 001 kg* m 2 


2 

(0. 167 oz-in-sec ) 

m 4 k 433 

= 

2 

0. 001 kg* m 

= 

(0. 156 oz-in-sec 2 ) 

m 5 


0. 63 kg 

= 

(0.058 (oz-sec 2 )/in) 

y 5 

= 

0. 03 » 0 cm 

= 

(0.01 = 0 in) 

7 5 

= 

5. 66 cm 

- 

(2. 23 in) 

m 5 k 511 

= 

2 

0. 003 kg* m 


(0.385 oz-in-sec 2 ) 

rn 5 k 522 

= 

2 

0. 003 kg* m 

= 

2 

(0. 360 oz-in-sec ) 

m 5 k 533 

S 

0. 0004 kg.m 2 

= 

(0.057 oz-in-sec 2 ) 

m 6 

= 

0.51 kg 

= 

(0.047 (oz-sec 2 )/in) 

*6 

= 

0. 14 * 0 cm 

= 

(0. 057 = 0 in) 

*6 


-9. 22 cm 

= 

(-3. 63 in) 

m 6 k 611 

s 

0. 005 kg* m 2 

S 

2 

(0.667 oz-in-sec ) 

m 6 k 622 

s 

0. 005 kg* m 2 

- 

2 

(0.667 oz-in-sec ) 

m 6 k 633 

= 

0.0003 kg*m 2 

S 

(0.049 oz-in-sec 2 ) 
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The two geometric parameters of the JPL RRP manipulator applied in 
the calculations are: 

r^ = 16.2 cm (6. 375 in) 

r^ = 24. 76 cm (9. 75 in) 


The input 

shaft inertias 

referred to the output 

are as follows: 

At joint No. 

Is 

0.953 kg.m 2 

2 

(135 oz-in-sec ) 

At joint No. 

2: 

2. 193 kg-m 2 

2 

(310. 6 oz-in-sec) 

At joint No. 

3: 

0.782 kg 

(0.07143 (oz-sec 2 )/in) 

At joint No. 

4: 

0. 106 kg* m 2 

2 

(15. oz-in-sec ) 

At joint No. 

5: 

0.097 kg.m 2 

2 

(13. 7 oz-in-sec ) 

At joint No, 

6: 

2 

0. 02 kg* m 

2 

(2. 81 oz-in-sec ) 


Derived metric conversion factors applied in 

this report are as follows 

Length: 

1 in 

= 2. 54 cm 

Mass: 

2 

1 (oz-sec )/in 

= 10. 945 kg 

Static moment: 

. 2 
1 oz-sec 

= 0. 278 kg< m 

Moment of inertia: 

1 4 2 
1 oz-in-sec 

= 0.00706 kg.m 2 

Force: 

1 oz 

= 0. 278 N 

Torque 

1 oz-in 

* 0.00706 N-m 


* Equivalent mass. 
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APPENDIX C 


MANIPULATOR DYNAMICS WITH LOAD IN THE HAND 


Suppose that a load in the hand will cause an offset in the mass center of link #6 
so that x 6 ^ 0 and y^ ^ 0 together with ^ 0. That is, the effective form of 
the mass center vector ~p ^ becomes: 



Of course, the effective form of the "pseudo inertia matrix" becomes also 
modified through the non- zero values of x^ and y^: 


2 \ K 61 1 


+ k 2 + k 2 
*622 *633 


Jz - m. 


) 0 0 

l( k 61l" k 622 + k 633) 0 

0 z( k 6ll 

*6 


+ k 622' k 633 ) z 6 


To illustrate the effect of the non- zero values of x^ and y^ on the manipulator 
dynamics, the necessary modifications for some of the dynamic coefficients are 
evaluated in explicit form, and listed below. 
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1 . 


Modifications in the gravity terms caused by ^ 0, yfr ^ 0 

a) For joint #2: 

The following terms should be added to given by Eq. ( J 8)- 

+gm 6 [x 6 (c 0 2 s0 4 c0 5 c0 6 - se 2 se 5 c0 6 + cQ^s^) 

+ y^t-cG^sQ^cB^sG^ + sQ^sQ ^sQ ^ + C ® 2 C 0 4 C 0 6 * 


(C. 1) 


b) For joint #4: 

The following terms should be added to given by Eq. (52): 
+ gm 6 s0 2 £x 6 (ce 4 c0 5 c0 6 - s0 4 sfl 6 ) 


- y6 (c6 4 ce 5 s6 6 + s0 4 c0 6 ) ] 


(C. 2) 


c) For joint #5 : 

The following terms should be added to given by Eq. (54): 


+gm 6 [x 6 c0 6 (-s0 2 se 4 s0 5 + c9 2 c0 5 


+ y 6 se 6 (s6 2 se 4 se 5 - C0 2 C0 5 )J 


(C. 3) 


d) For joint #6 : 

If x 6 and/or y^ are different from zero, then will also be different 
from zero. Instead of Eq. (56), we will have now: 

D 6 = “ gm 6 [*6 <80 2 80 4 c0 5 80 6 + c0 2 80 5 80 6 " 80 2 c0 4 c0 6 ) 

+ y 6 (s0 2 s0 4 c0 5 c0 6 + c0 2 s0 5 c 0 6 + s0 2 ce 4 s0 6 )] 

(C. 4) 

It is noted that i 0 and y^ i 0 cannot have any effect on Dj and Dy 
C-2 JPL Technical Memorandum 33 -669 




2 . Modifications in the acceleration- related uncoupled terms caused 
by x& ? 0, yfe * 0 

The and D,.^ dynamic coefficients given by Eqs. (68) and (66), respectively, 

will remain unaffected by i 0 and/or y^ ^ 0 . Furthermore, t o and/or 
y^ i 0 canrxct have any effect on D^. Only ^44' ^22’ anc * 1 be m °di- 

fied due to / 0 and / or t 0« 

a) Modification for D 44 : 

The following term should be added to D44 given by Eq. ( 64 ): 


+2m 6 r 6 s WV e 6 ' y 6 se 6* 


(C. 5) 


b) Modifications for D£2 and D^: 

The following terms should be added to & 2 Z 8^ ven by Eq. ( 60 ); 

+2m 6 j x 6 [r 6 s0 4 s0 5 (c0 4 se 6 + S0 4 c0 5 c0 6 ) - (r^ + r 3 )s0 5 s0 6 ] 

+ ^6 [ s0 5 s0 6 (r 6 c0 5 + r 3> " r 6 80 4 s0 5 (s0 4 c0 5 80 6 ~ c0 4 c0 6 ) ]| (C * 6) 


The following terms should be added to Djj given by Eq. (58): 


+2m 6 x 6 


r 6^ c0 2 80 4 80 5 + s0 2 c0 5^ ' r 3 80 2 ( c0 2 80 4 c0 5 c0 6 “ 80 2 80 5 c0 6 + c0 2 c0 4 80 6 ) 


+ (r^c0 4 s0g - r^) (c0 4 c0gC0^ - s0 4 s0^)| 


<C. 7) 

+2m 6^6 [ r 6 (c0 2 80 4 80 5 + 80 2 c 0 5 ) + r 3 s0 2] W 0 6 +c0 2 c0 4 c0 6 ' c0 2 80 4 c0 5 80 6 ) 


+ (r 2 “ r 6 c0 4 80 5* ( ce 4 c0 5 c0 6 + 80 4 c0 6*j 

2 2 2 

It is noted that the number values of the k^jj. ^522' an< * ^633 ra ^ us °* gyration 
terms will also be changed in the "pseudo inertia matrix" when there is a load in 
the hand. Of course, this change will not produce additional terms in the state 
functions for the dynamic coefficients; it will only change the constant 
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number values of the k^.^, an£ * ^£>33 P arameters whenever they appear 

in the state functions for the D„ dynamic coefficients, Eqs. (58), (60), (64), 

(66), (68). t) 


i 



I * 

* 



t) It is assumed here that the cross products Id the "pseudo inertia matrix" 
will remain aero. If this is an unsatisfactory approximation, then addi« 
tional terms will appear in the state functions for the dynamical 
coefficients. 
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APPENDIX D 


SIMPLIFICATION OF THE GENERAL MATRIX ALGORITHM FOR 

MANIPULATOR DYNAMICS 


The general algorithm for manipulator dynamics applied in Refs. 5 through 8, 
and employed also in our analysis, is given by Eq. (1) in the main text of this 
report. According to Eq. (1), the dynamic coefficients D„ and D^ * n the 
general equations of manipulator motion are expressed in terms of the Trace 
of the products of 4 by 4 matrices. Essential "building blocks" of the matrix 
products are the first and second partial derivative matrices and U.^ 
defined by Eqs. (4) and (7) in the main text. The purpose of this Appendix is 
to show that the application of the and U. ^ matrices in the complete form 
as defined by Eqs. (4) and (7) is unnecessary in the computation of the 
acceleration- and velocity- related dynamic coefficients D^ and D.^* 


Statement: 


1 2 

All link coordinate transformation matrices Tq, T^, ... which 
have upper index number smaller than the smallest upper index 
number (say "i") of a derivative matrix QT| ^ can be omitted 
from the Trace of matrix products corresponding to the defin i- 
tions of the D.. and D. dynamic coefficients given by the matrix 
algorithm of Eq. (1). 


For instance, according to the Statement, the Dgg inertial term and the 
Coriolis term can be computed using the following simplified formula: 


D 55 = Tr I T 0 T 1 T 2 T 3 QT 4 S 5 


(tJti t3 2 t 3 Q<) T ] 


omit! 


omit! 


[’ 


+ Tr ITqTjT^Tj QT*T|j 6 


( T i T f T l T 3 


omit! 


omit! 
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Tr 


D 


4, 56 “ 


12 3 4 5 6 

T 0 T 1 T 2 T 3 QT 4 QT 5 J 6 


(t 1 qt^t^t^ 

V012 W 3 45 



omit ! 


omit ! 


As seen in the two examples quoted above, the introduced simplification reduces 
the computational complexity substantially. In the case of D^, the original 
formula calls for the evaluation of the Trace of the product of 13 and 15 
matrices, while the introduced simplified formula calls for the evaluation of the 
Trace of the product of 5 and 7 matrices only. In the case of the 

original formula requires the computation of the Trace of the product of 
16 matrices, while the proposed simplified formula requires the computation 
of the Trace of the product of 10 matrices only. (It is recalled that all matrices 
are 4 by 4 matrices. ) 


The validity of the introduced simplification of the algorithmic formulas for the 
D.j and D.^ dynamic coefficients for any manipulator can be shown oy general 
matrix manipulations elaborated briefly below. The essence of the proof is 
to show that the effect of the link coordinate transformation matrices omitted 
from the Trace of matrix products is equivalent to the effect of the identity 
matrix in the chain- product of matrices. To make the proof concise, two 
lemmas will be stated which are related to the properties of the general 4 by 4 
link coordinate transformation matrix T* 

l- 1 


C0. 

1 

-cor.s0. 
1 1 

s a. s6. 
l l 

a.c0. 
i i 

80. 

1 

cor.cG. 
l i 

-8CT.C0. 
1 1 

a. 80. 

i l 

0 

8 Of. 
l 

car. 

l 

r. 

i 

0 

0 

0 

1 


Lemma 1 : The general structure of the product 


R ik i 




for any "i" and "k" is as follows: 
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.ik 


1 

0 

0 

R 


ik 

14 


0 

1 

0 

ik 

l 24 


0 

0 

1 


R 


ik 

34 


R 

R 

R 


ik 

1 14 

ik 

24 

ik 

34 

ik 

44 


r ll 

r 1 2 

T ' 

I / 12 

r 22 J 


(D. 2) 


where the r^ j submatrix is always the 3 by 3 identity matrix and = r^. 
(That is, Rik is a symmetric 4 by 4 matrix. ) Lemma 1 can be proved by 
direct multiplication and induction. 


Lemma 2: The general structure of the product 




B ik 

= T l-1 

T k 

T k-i 



for any "i" and " 

k" is 

as follows: 






R ik 

B 11 

B ik 

B 12 

B ik ; 
B 13 , 

B ik 

B 14 




B ik = 

B ik 

B 21 

r*ik 

B 22 

i 

n ik ' 
B 23 ; 
1 

B 24 


" b n 

; b i2 


B ik 

B 31 

B ik 

B 32 

B ik ; 
B 33 , 

1 

B ik 

B 34 


0 

1 i 


0 

0 

o ; 

1 





that is, the submatrix is always zero, and b.^ i® always equal to 1. 

Lemma 2 can be proved by direct multiplication and induction. 

Let the following partitioning be introduced for a symmetric matrix P, a 
skew- symmetric matrix Q, and an elementary matrix (J: 


D-3 


JPL Technical Memorandum 33-669 



I 

P 11 

P 12 

P 1 3 

; p h 




p = 

P 12 

P 22 

P 23 

i 

' P->A 
i 24 

1 


p n : 

_ _ . j 

P 1 2 


P 13 

P 23 

P 33 

1 P 34 
u - . - 


t ; 

p i2 ; 

P 22 


P 14 

P 24 

P 34 

: p 44 





where p^ j is a symmetric 3 by 3 submatrix, Pjj * Pn* Further, 


(D.4) 



(D.5) 


where is a skew- symmetric 3 by 3 submatrix, qjj = - q^. Ut * 8 
obvious that = - Q. ) Further, 



(D.6) 


where q^ i* an elementary 3 by 1 submatrix. It is noted that the Q and ff are 
the differential operator matrices related to rotary and linear joints, respec- 
tively, while the symmetric P matrix is simply identical to the symmetric 

pseudo inertia matrix J. (see Eq. (10)), or it is constructed as P * B^J. (B^)^ 

ik K K 

where B is given by Eq. (D. 3). 

The following rules related to the Trace operator are recalled: 

Tr(C) « Tr(C) T (D.7) 
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for a square matrix C, and 


Tr(ABC) = Tr(BCA) = Tr(CAB) (D. 8) 

if A is of order (m X k), B of order (k X r) and C of order (r X m). Of course, 
if we define, for instance, BC = D.then we also have: Tr(AD) = Tr(DA). 

Using the properties and rules stated by Eqs. (D.2) through (D, 8), the validity 
of the introduced simplification of the algorithmic formulas for the and 
dynamic coefficients for any manipulator can be proved through the following 
steps: 

1. Rearrangement of the chain product of the 4 by 4 matrices under 

ik 

the Trace operator so that the R matrix product group will be 

ik 

isolated. (It is noted that for R i = 1 and k = j - 1, j being the 
lowest index number for a derivative matrix which appears in the 
general formula. ) 

2. Then, the matrices under the Trace operator are arranged in a 
form Tr(PM) where M is a chain product of matrices containing 
also the R matrix. 

3. Finally, the elements of the M matrix are determined by direct 
multiplication in a partitioned form similar to the partitioning 
introduced in Eqs. (D.2) through (D. 6) for the R^, B^, P, Q, 
and Q matrices. This last step then reveals that the four sub- 
matrices of M 


m U j m 12 

1 

m 21 ! m 22 

will only contain the submatrix r^j, that is, the r^ and ^2 
submatrices of will not appear in the four submatrices of 
M. Since the remaining submatrix is the identity matrix, 
it (or equivalently, the matrix) can be omitted from the 
M matrix. That proves the validity of the algorithmic simplifi- 
cations for d ij and D ijk stated in this Appendix. 
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The three major steps of proof for the algorithmic simplification of the 
and dynamic coefficients are compiled in the subsequent pages for 

different combinations of rotary and linear joints. The derived formulas 
reveal the nature of the introduced algorithmic simplifications in detail and 
immediately show some interesting structural and symmetry relations for the 
different dynamic coefficients. 


A. Acceleration-Related Dynamic Coefficients 
1. Diagonal Coefficients, 


a. Rotary joints. 

The general component of takes the following form after rearrangement:^ 


Tr(RQBPB T Q T ) = Tr(PB T Q T RQB) 


M 


Direct multiplication results 


M 


Consequently, 



(D.9) 


Tr(PB T Q T RQB) u* Tr(PB T Q T QB) 


(D. 10) 


^For clarity in writing, the superscripts are omitted from the R and B 
matrices. 
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b) Linear joints. 

Rearrangement yields for the general term: 


Tr(RQBPB T Q T ) 


Tr(PB T Q T RQB) 


M 


Direct multiplication results: 


M = 



0 I 0 

1 


1 

O 

( o 


A I -T - 

““ 

*1 


0 . < >12 r ll‘>12 

L- a J 


L° ; 1 J 


omit 


Consequently, 

Tr(PB T Q T RQB) Tr(PB T Q T QB) = Tr(PM) = p 22 
where p 22 is simply the mass of a link. 

2. Off-Diagonal Coefficients D. . 

- LI 


a) Two rotary joints . 

Rearrangement yields for the general term: 


Tr(RQBPQ T B T ) * Tr(PQ T B T RQB) 


M 


(D. 11) 


(D. 12) 
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i^Sfci 


Direct multiplication results: 


omit 


T T S IT T\ 

q l l b l 1 r l l q l l b l 1 ! q ll b ll r il q ll b 12 


(D. 13) 


Consequently, 


Tr(PQ T B T RQB) Tr(PQ T B T QB) 


(D. 14) 


The symmetry D.^ = is easily seen since 


Tr(PQ T B T QB) = Tr(PB T Q T BQ) 


b) One linear and one rotary joint. 


Rearrangement yields for the general term: 


Tr(RQBPQ T B T ) * Tr(PQ T B T R(5B) 


Direct multiplication results: 


omit 
; T.T I — 


(D.15) 
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Consequently, 


Tr(PQ T B T RQB) <=* Tr(PQ T B T QF) = m (D. 16) 

T 

Since m iz a sca l ar > the symmetry D_ = D.. in this case is obvious, 
c) Two linear joints. 

Rearrangement yields for the general term: 


Tr(RQBPQ T B T ) = Tr(PQ T B T RQB) 


Direct multiplication results: 


M 



0 j 0 


1 

o 

O 

1 

M = 

1 

■ r 

= 

1 


„ 1 _t,t - 


1 

0 1 m, 

1 22 


0 ! q 12 b ll*ll q 12 



Consequently, 


omit 


Tr(FQ T B T RQB) Tr(PQ T B T QB) = p 22 m 22 


(D. 17) 


(D. 18) 


Since p 22 m 22 is a scalar, the symmetry in this case is also 

obvious. 
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Velocity-Related Dynamic Coefficients 


Centripetal term s 
Rotary joints. 


Di i < k: Centripetal effect of the outer joints felt at the inner 
rotary joints. 

Rearrangement yields for the general term: 


Tr(RBQQPB T Q T ) = Tr(PB T Q T RBQQ) 


M 


Direct multiplication results: 

omit 

b ll q ll r U b ll q ll q ll | ° 


M = 


b i2 q n r n b ii q ii q n 


.. 


omit 


Consequently, 


Tr(PB T Q T RBQQ) «**> Tr(PB T Q T BQQ) 


(D. 19) 


(D. 20) 


Dj i > k: Centripetal effect of the inner joints felt at the outer 
rotary joints. 

Rearrangement yields for the general term: 


Tr(RQQBPQ T B T ) a Tr(PQ T B T RQQB) 


M 
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Direct multiplication results: 


omit 

omit 

r / 

/ n 

T , T / . ! 

T.T / 

q n b n n q ii q n b n : 

1 

q ll b ll r il q ll q ll b 12 

\ 

o ; 

0 





Consequently, 


Tr(PQ T B T RQQB) Tr(PQ T B T QQB) 
b) Linear- rotary joint pairs, 

aa) i < k: Centripetal effect of the outer rotary joints felt at 

inner linear joints. 

Rearrangement yields for the general term: 


Tr(RBQQPB T Q T ) = Tr(PB T Q T RBQQ) 


M 


Direct multiplication results: 


M = 


— T 

9 i ? r i 1^11^11^1 


12 11 11 M 11 M 11 | 


\ 


omit 


Consequently, 


Tr(PB T Q T RBQQ) Tr(F5 T BQQ) 


(D. 2 1 ) 


(D. 22) 


the 


(D. 23) 


(D. 24) 
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D. , , , i > k: Centripetal effect of the inner rotary joints felt at the 
1; KK 

outer linear joints. 

Rearrangement yields for the general term: 


Tr(RQQBPQ T B T ) = Tr(PQ T B T RQQB) 


M 


Direct multiplication results; 


M 


(D. 25) 


Consequently, 


rp 1 (p 

q 12 b ll r jll q ll q ll b ll | q 12 b ll^ll q ll q ll b 12 
omit omit 


Tr(PQ T B T RQQB) Tr(PQ T B T QQB) 


(D. 26) 


Remarks. 


D. .. = 0 is physically obvious. But it can easily be seen also from the 

X, 11 

matrices as follows. 

Rearrangement yields for the general term: 


Tr(RQQPQ ) = 


Direct multiplication results: 


M 



r T / i 

| ; 0 


i "1 

1 

© 

© 

1 


1 

o 

o 

1 
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Consequently, 


Tr(PM) = Tr(PQ) ^ 0 

since P is a symmetric matrix and Q is a skew-symmetric matrix. 

(The Trace of the product of a symmetric and a skew- symmetric 
matrix is identically zero. ) 

bb) The close relationship between Eqs. (D.22) and (D. 14) - that is between 
D.. for two rotary joints and D. 1 , for i > k rotary joints - is noteworthy. 

1 J 1 , iCK 

For these two types of dynamical coefficients the final expressions 
become: 

for D..: T'(Pi l 1nbJ' 1 q 1 ,l>„) + p' u‘>n b n < >i l b 12 


rp fjp (J* (Ji 

for D i,kk : Tr(p ll q ll b ll q ll q ll b ll ) + 


’l2 H ll u ll q ll s ll u 12 


2 . 


Coriolis terms 


The Coriolis terms are characterized by three indices separated into two 
groups: i, kj with k i j but i can be equal to k or j. (k and j are interchange- 
able. ) The values of i, kj allow several combinations: i < k, j with k < j; 
k < i, j with i < j; k < i, j with i > j; i = k with i < j; i = k with i > j. Further, 
both linear and rotary joints can be associated with the three i, kj indices. 
Thus, the index values together with the associated joint types result in a num- 
ber of cases to be considered. 


a) D i,kj* i * k * j and k * j 

1) Three rotary joints (e.g., 

Rearrangement of the general term yields: 

Tr(P B»B T Q T RBQB»Q) * 

M 

^Here and in the subsequent pages, the B and B* matrices have identical struc- 
ture as specified by Eq. (D.3), but their elements (that is, their omitted upper 
indices) are different. 
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Direct multiplication results: 


omit 


M = 


b il b n q n' : u b ii q n b ii q ii 


( b i 2 b u q n tb u q n) 5n b u q n b n <l ii i 0 


V. 

omit 


Consequently, 


Tr(PB* T B T Q T RBQB*Q) Tr(PB* T B T Q T BQB*Q) 


One linear and two rotary joints. 

i is linear, k and j are rotary joints, (e. g. , ^ ) 

Rearrangement of the general term yields: 


Tr(PB* T B T Q T RBQB*Q) 


M 


Direct multiplication results: 



0 

! 0 " 

M = 

_ q 12*ll b ll q ll b ll q ll 

l 

• 1 

1 

• 0 
1 


\ 


omit 


Consequently, 

Tr(Pii* T B T ?5 T RBQB*Q) Tr(P?3 T BQB*Q) 


(D. 27) 


(D. 28) 


(D. 29) 


(D. 30) 
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bb) i and k rotary joints, j linear joint. 


Rearrangement yields for the general term: 


Tr(PB* T B T Q T RBQB*Q) 


M 


Direct multiplication results: 


M = 


omit 

, *T, T T ^ — 

b ll b ll q ll r ll b ll q ll b ll q 12 


a \ T T . , T T \ , u * - 

0 ] (b 12 b 1 l q l 1 + b 12 q ld r t ll b ll q ll b ll q 12 


omit 


Consequently, 

Tr(PB* T B T Q T RBQB*Q) = Tr(PB* T B T Q T BQB*Q) 

cc) i and j rotary joints, k linear joint, (e.g., D ^ 34 ) 
The general term is: 

zero 

Tr(PB* T B T Q T RBQB*Q) 5 0 


since SB* = <5 and <5 q = 0. 


(D. 31) 


(D. 32) 


3) One rotary and two linear joints. 

Only one combination can be different from zero: 
k is rotary while i and j are linear joints. 
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» 


■ 



Rearrangement yields for the general term: 


Tr(PB* T B T Q T RBQB*Q) 


M 


I 

i 

f 

i . 


Direct multiplication results: 


M = 


— T 


0 ; < ’i2 r n b ii q ii b ii'>i2 


\ 


omit 


Consequently, 


Tr(PB* T B T Q T RBQB*Q) <=> Tr(PQ T BQB*Q) 


(D. 33) 


(D. 34) 


The other possible two linear and one rotary joint combinations yield 
identically zero Coriolis terms since both C2BQ and QBQ are zero 
matrices. 


b) D i f kj' k< J and 1 * 

1) Three rotary joints (e.g., ^ ) 

Rearrangement yields for the general term: 

Tr(PQ T B* T B T Q^BQB*) 
M 


K.; 

‘'l-k 
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Direct multiplication results: 



(D.35) 


Consequently, 

Tr(PQ T B* T B T Q T RBQB*) Tr(PQ T B* T B T Q T BQB*) (D.36) 


2) One linear and two rotary joints. 


aa) i is linear, k and j are rotary joints (e.g.. 
Rearrangement of the general te rm yields: 


Tr(PQ T B* T B T Q T RBQB*) 


M 


Direct multiplication results: 

omit 

1 

M = 

0 q n b i? b n q n r ii b n q i 2 

i 

• 


0 J 0 


Consequently. 


Tr(PQ T B* T B T Q T RB<5B*) ++ Tr(PQ T B* T B T Q T BQ) 


(D. 37) 


(D. 38) 
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i and k rotary joints, j linear joint. 
Rearrangement yields for the general term 


Tr(PQ T B* T B T Q T RBQB*) 


Direct multiplication results: 



(D. 39) 


Consequently, 

Tr(P<5 T B* T B T Q T RBQB*) Tr(PQ T B* T B T Q T BQB*) (D.40) 

) i and j rotary joints, k linear joint (e.g., ^ 5 ) 

The general term is now: 

Tr(PQ T B* T B T Q T RBQB*) = Tr [p(QBB*Q) T RBQB*] s 0 

zero 


since QBB* = Q and QQ = 0 


One rotary on two linear joints. 

Again, only one combination can be different from zero: k is rotary 
while i and j are linear joints. 

Rearrangement yields for the general term: 


Tr(PQ T B* T B T Q T RB?5B*) 


M 


JPL Technical Memorandum 33-669 



Direct multiplication results: 


M = 


(D. 41 ) 


q ?2 b i? b n q n r n b ii q i2 


omit 


Consequently, 

Tr(PQ T B* T B T Q^BQB*) <=*> Tr(PQ T B* T B T Q T BC5) (D. 42) 

Again, '■he other possible two linear and one rotary joint combinations 
yield identically zero Coriolis terms since both QBQ and QBQ are 
zero matrices. 


c) D i,kj' k * j and * * J* 

1) Three rotary joints (e.g. , ^ 4 ) 

Rearrangement yields for the general term: 


Tr(PQ T B* T B T RQBQB*) 


M 


Direct multiplication results: 


.omit 


M 


q n b 


i? b n r ii q n b n q n b h 



q n b ii b n r ii q n b n q ii b i2 


J 

# 


(D. 43) 
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Consequently, 


Tr(PQ T B* T B T RQBQB«) <t^> Tr(PQ T B* T B T QBQB*) 


2) One linear and two rotary joints. 

aa) i is linear, k and j are rotary joints. 

Rearrangement yields for the general term: 


Tr(PQ T B* T B T RQBQB*) 


M 


Direct multiplication results: 


0 


0 


M = 


■I 


^i2 b i? b n r ii <J n b ii q ii b ii 


■ omit 



Consequently, 

Tr(FO T B* T B T RQBQB*) Tr<FO T B* T B T QBQB*) 

bb) i end k rotary joints, j linear joint, (e.g., ^ 3 ) 

Rearrangement yields for the general term: 

Tr(PQ T B* T B T RQB3B*) 


(D. 44) 


(D. 45) 


(D. 46) 
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Direct multiplication results: 


omit 


M = 


/ 


T * T T r - 

q ll b ll b ll r ll q ll b ll q 12 


Consequently, 

Tr(PQ T B* T B T RQBQB*) <«> Tr(PQ T B* T B T QB3) 

cc) i and j rotary joints, k linear joint (e. g. , ^ 4 ) 

The general term is now 

Tr(PQ T B* T B T RQBQB*) 3 0 

_ _ _ zero 

since QB = Q and QQ = 0. 


(D. 47) 


(D. 48) 


3) One rotary and two linear joints . 

Again, only one combination can be different from zero: k is rotary 
while i and j are linear joints. 

Rearrangement yields for the general term: 


Tr(Pt5 T B* T B T RQBffB*) 


M 


Direct multiplication results: 


0 ; 0 

1 

mmmmmm-mmmmmmmmm 

0 ! ^I2 b ?? b 7l 'l l q l l b l 1^12 

omit 


(D. 49) 
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Consequently, 


Tr(P<3 T B* T B T RQBQB*) <*> Tr(PG T B* T B T QBQ) 


(D. 50) 


Remark 

Recalling that = - Q, and comparing Eq. (D. 36) to Eq. (D.44), Eq. (D. 38) to 
Eq. (D.48), Eq. (D.40) to Eq. (D.46), and Eq. (D.42) to Eq. (D. 50) it is 
seen from the right hand side of the respective equivalence expressions that 


Eq. (D. 36) = 
Eq. (D. 38) = 
Eq. (D.40) = 
Eq. (D.42) = 


- Eq. (D.44) 

- Eq. (D.48) 

- Eq. (D.46) 

- Eq. (D. 50) 


That is, we have in general: 


D i.kj = • D j,M tork<i -'> 


d) D. . . with i < j 


1) Three rotary joints (e. g. , D^ 24 ) 

Rearrangement yields for the general term: 


Tr(FB T Q T RQBQ) 


M 


Direct multiplication results: 

omit 


M 


X T J • 

b ll q ll r ll q ll b ll q ll | 

T T I 

b 12 q ll r ll q ll b ll q ll » 


olnit 


9 

m 

0 


(D. 51) 


(D. 52) 
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Consequently, 


Tr(PB T Q T RQBQ) <*=> Tr(PB T Q T QBQ) (D. 53 ) 

2 ) One linear and two rotary joints (e.g., ^3) 

The Coriolis term can only be different from zero if j is the linear 
joint. 

Rearrangement of the general term yields: 


Tr(PB T Q T RQBQ) 


M 


Direct multiplication results: 

omit 



0 

b ll q ll r ll q ll b ll q 12 


0 

' T T — 


\ b 1 Z q 1 1 r 1 1 q 1 l b 1 l q 1 P 



1 . 


omit 


Consequently, 

Tr(PB T Q T RQBQ) Tr(PB T Q T QB(5) 


e) D. . . with i > j 

1# ij J 

1) Three rotary joints (e.g. , Dg g^) 

Rearrangement of the general term yields: 

Tr(PQ T B T RQBQ) 

M 


(D. 54 ) 


(D. 55 ) 
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i 



Direct multiplication results 


omit 


M = 


q n b n r n q ii b ii q n i 0 


(D. 56) 


Consequently, 


Tr(PQ T B T RQBQ) <=t> Tr(PQ T B T QBQ) = Tr ^BQP(BQ) T Q j = 0 


K 


(D. 57) 


Since K is a symmetric matrix while Q is a skew- symmetric matrix, 
and the Trace of the product of asymmetric and skew- symmetric 
matrix is identically zero. 


2) One linear and two rotary joints (e. g, , D, _) 

Due to thf assumption that i > j, j must be the rotary joint. 
(Otherwise we would have QBQ s 0 automatically. ) 

Rearrangement of the gene. .*al term yields: 


Tr(PQ T B T RQBQ) 
M 


Direct multiplication results: 


M = 


— T T — 

q 12 b nfll q ll b ll q 12 


omit 


(D. 58) 


D-24 


JPL Technical Memorandum 33-669 


Consequently, 


Tr(PQ T B T RQBQ) <^> Tr(PQ T B T QBQ) = Tr [bQP(BQ) T q] = 0 

K 

since the Trace of the product of a symmetric matrix (K) and a 
skew-symmetric matrix (Q) is identically zero. 


Thus, 


the Coriolis term 


D. . with i > j is identically zero in all 


JPL Technical Memorandum 33-669 

ham - jn - cmi., i.a.. out. 


(D. 59) 


cases. 


D-2S 



